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relative coordinates. An observability analysis is then 
performed on the resulting series of nonlinear equations, 
which in turn forms the basis for the design of a determin- 
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I. INTRODUCTION 



In pursuit of an interest in the problems and potential 
of satellite tracking of earth's surface or low altitude 
targets, the interested student quickly discovers a plethora 
of information available on the subject, but little in the 
way of analysis of the entire problem, sta rt-to-f inish . The 
purpose of this report then is to provide that analysis, 
beginning with the mechanics of the orbiting satellite; next 
developing a model to represent the target motion; and 
continuing through an observability analysis of the problem. 
Finally, a first-cut attempt is made, based on the observ- 
ability study, to design a deterministic nonlinear observer 
and an Extended Kalman Filter (hereafter referred to as an 
EKF) to observe and track the target. 

Chapter II of this report examines in depth the physical 
dynamics of a satellite orbiting the Earth, and then the 
target moving on or just above its surface. A working model 
is developed for the satellite, including a look at its 
ground track; its rotation about its own axes as it moves 
through space; and the translation of its raw observed data 
into earth's surface coordinates. Both position and rate 
data are considered, and specific formulae are developed 
along the lines of a computer algorithm for coordinate 
transformation . 

Chapter III deals more specifically with the model for 
the target itself. Actually, two models are considered: 
first, a realistic model, necessarily nonlinear, due to the 
non-synchronous motion of the target and satellite on 
concentric spheres; and then secondly a slightly nonreal- 
istic linearized version. Both surface and air targets are 
considered, but for brevity's sake, only the surface target 
is discussed fully in the va does examples. 



Chapter IV finally tackles the problem of state observ- 
ability. Observability, as defined here and in [Eef. 1], is 
the capability, given the observations and knowledge of the 
control input to the system over time, to reconstruct the 
entire system state tack to the initial condition. Testing 
for this condition on a linear system is perfectly straight- 
forward; the method is fully developed in [Ref. 2] and else- 
where. The observability of the nonlinear system is by far 
the mere interesting problem, as the problem is more real- 
istic, and the methodology for testing of nonlinear observ- 
ability is far less well developed and/or documented. To 
that end, the method which is newly developed in [Ref. 1] is 
herein employed, and the analysis ultimately becomes as much 
of a test of the method as the observability of the system. 

Based on the results of the analysis in Chapter IV, 
Chapter V is then an admittedly imperfect, first-cut attempt 
at designing a deterministic nonlinear observer, and then 
tracking the target with an SKI. The comments in [Ref. 3] 
concerning filter initialization and measurement covariance 
estimation become pertinent. 

Finally, Chapter VI summarizes the thesis' results, and 
makes some suggestions for further analysis, specifically in 
the area of multiple targets and observers. The real-world 
significance of the report is also discussed. 
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II. SA TEL LITE DYNAMICS AND OBSERVATION OF TARG ETS 

In considering the tracking of a surface or air target 
by a satellite hurtling through space at speeds approaching 
15000 knots, it is obviously imperative to understand the 



relative coordinate system be established, with the ultimate 
goal of describing the target's motion over the Earth's 
surface; first, however , the satellite's own motion must be 
similarly described. 

In the following derivations, the Earth will be approxi- 
mated by a unif ormly-dense, perfect sphere. This approxima- 
tion has often been characterized qualitatively as being 
twice as good as that of a "spherical” basketball; its quan- 
titative implications will be discussed in Sections B and C 
below . 

A. SATELLITE REFERENCE ORBIT 

Lagrangian Mechanics, as developed in [Ref. 4] offers 
the easiest method for analyzing the satellite’s moticn. 
The Earth and the satellite can each be represented by point 
masses; in the absence of external disturbances, it can be 
shown that the satellite's orbit will remain planar. The 
gravitational potential of the satellite is inversely 
proportional to its distance from the Earth; using circular 
polar coordinates as shown in Figure 2.1, this potential 
energy ~\f is then described by 



where G is Newton's constant of universal gravitation, M is 
the mass of the Earth, and m is the mass of the satellite. 



dynamics of the moticn of the satellite. Only then can a 
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Figure 2.1 Satellite Orbit in its Plane 



The circular orbit is the sinpiest case, such that the 
velocity is purely tangential and can be characterized as 

H.- * • 



The kinetic energy 1 is then 
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and in the absence of any external disturbances, 
Lagrangian function is written as follows: 
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or 




( 2 . 2 ) 



Equation 2.2 indicates that angular momentum is 
conserved (i.e. its derivative is zero), and that will be 



then the fact of its conservation indicates that the orbit 
will remain stable in its original plane. The introduction 
of a third coordinate, which ultimately becomes the angle of 
inclination i, and which remains arbitrary throughout the 
Lagrangian derivation, proves this conclusively. 

Solving equation 2. 1 for the the physical constants 
reveals that 



for a satellite in an earth orhit; this is Kepler’s Second 
law of Orbital Motion. 

The radius in this equation is the distance of the 
satellite from the Earth’s center; for altitude above the 
Earth, the Earth's radius, here represented as 



constant for a given orbital radius. Further, if the 
angular momentum vector is interpreted as 




v’<t> - GM-. 



Considering that Q - j- 

where T is the satellite's period, then 
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must be subtracted, i.e. 



b = r - r o . 

Of special interest is the satellite at zero altitude, 
also known as a Herget satellite, with a period of 84.5 
minutes. As [Bef. 5] indicates, this gives a value for the 
lower bound of a satellite's period. Some other periods and 
altitudes of interest are summarized in Table I : 



TABLE I 

Typical Periods, Altitudes, and Orbital Velocities 



Feriod T 

90 min 
3 hr 
6 hr 
12 hr 
23 hr l 



6 min 



Altitude h 



Orbital Velocity 



150 
2250 
5600 
1 0900 
19322 



nir 
n n 
n m 
nm 
n m 



15030 
1 1930 
9470 
7510 
5970 



knots 

knots 

knots 

knots 

knots 



This last orbit, with a period of one solar day, is the 
geosynchronous orbit frequently adopted in satellite commu- 
nications applications; for tracking of surface-bound 
targets, however, low-altitude orbits will be of much 
greater interest. Typical altitudes will generally be less 
than 1000 nautical miles, depending on the sensitivity and 
accuracy of the tracking sensor: this corresponds to 
periods of two hours or less. 

Finally, it can be shown by the method of the potential 
energy well [Bef. 6], and also by the application of the 
theory of perturbations [Ref. 4], that this reference crtit 
will be stable in the presence of small disturbances in 
either the orbital plane or the third dimension, and these 
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dist urbances will produce oscillations about the reference 
orbit with its same period, i. e - 



B. SATELLITE GROUND TRACK 

The earth-satellite model as developed in Section A is 
obviously over-simplified for the purposes of target 
tracking; thus far, the Earth has been represented only as a 
point mass rather than as a spinning globe, which would make 
it extremely difficult to describe any motion across the 
Earth’s surface. 

One intrinsic feature of a satellite’s orbit used in 
measuring its flight path is the inclination angle i, which 
represents the positive angle between the orbital plane and 
the equatorial plane. This angle can be used, together with 
earth’s surface coordinates, to describe the path over 
ground, or ground track, of the satellite. 

In Figure 2.2, the Z axis coincides with the Earth's 
polar axis; L and /\ measure ncrth latitude and east longi- 
tude respectively; and r, 4) , and \ describe the satel- 
lite’s motion in its orbital plane as before. 

If the satellite is considered to have originally 
orbited in the equatorial plane, its position would have 
been described by 




X " 'T CoS § 





=t = o . 
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Figure 2.2 Inclination of the Orbital Plane 



If the orbital plane is then rotated about the X axis 
through i degrees, then the coordinates are transformed by 

1 



T 



I o o 

O CGi »- t 

G S i O u s 



that is, now 



"X = r ccs 

- 'T CoS c i 

- 'TSi/VJC^) fii’vj c f 

and the latitude and longitude are described by 



(2.3) 
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If the Earth were truly a stationary sphere, these equa- 
tions would be sufficient to describe the satellite’s 



motion. Because the Earth is actually spinning under the 

satellite, however, angular rates must be considered, so 
that the Earth’s rotational speed (shown as in Figure 

2.2) may likewise be considered. Therefore equations 2.3 

and 2.4 above must be differentiated with respect to time as 
follows (note that i is time-independent) : 
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X * 
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— 'C SvM ( 
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Substitute equations 2.5 into equations 2.6, 
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(2.7) 
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Consider now that the Earth is rotating in an easterly 
direction; the rate at which east longitude is traversed by 
the satellite is now decreased by the Earth’s rotational 
speed, or 




COS l <\> 

CcS 7 $ -* Sn'^cgs 1 t 






( 2 . 8 ) 
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Figure 2.3 Satellite Ground Track. 
For a Nominal Period of Ninety Minutes 
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Figure 2.<l Satellite Ground Track 
For a Nominal Period of Twelve Hours 



The last factor that must be considered to achieve abso- 
lute accuracy in predicting the satellite's orbital path is 
the non-spherical shape of the Earth; to wit, the Earth is 
actually a slightly oblate ellipsoid, which causes a slow 
drift, or precession, of the satellite's orbital plane 
around the Earth with respect tc the fixed stars. [Bef. 5] 
includes a detailed discussion cf the effects of precession 



on the orbital 
for precession 
for a circular 


plane, 
rate, 
orbit , 


including the derivation of a formula 
which is offered here without proof; 
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PRECESSION ROTE IN DEGREES PER 1)0 1 

- 12.0 -».0 M.O 0.0 1.0 BO 12.0 



which appears to be a potentially large number, but as 
Figure 2.5 indicates, is actually only a few degrees per 
day. V’hen one considers that the typical tracking satellite 
makes a dozen or more revoluticns of the Earth daily, the 
change in the ground tracks of Figures 2.3 and 2.4 would be 
quite small for each revolution; further, as long as the 
satellite's ground station is aware of the precession and 
makes compensation for it, there is no discernable error 
introduced into the target tracking problem. 
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Figure 2.5 Precession Rates 
For Various Altitudes and Inclinations 
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C. EARTH COVERAGE 



The 

coverage 



key guantities 
for either a 



to consider when 
single satellite. 



discussing Earth 
or an array of 
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satellites, are the related concepts of swath width and 
revisit time interval. Swath width relates directly to that 
area viewed by the satellite as it passes overhead; revisit 
time is the measure of how frequently a particular point on 
the ground is in view from a passing satellite. 

i 1 



The first aspect of swath width to be considered is the 
maximum viewing angle, or Geometric Swath Width (GSW) . As 
shown in Figure 2.6, this is the maximum viewable area by 
the satellite, and is related tc the altitude as follows: 



•SKTcLCVTc: 




Figure 2.6 Geometric Swath Width 





or 




(2.9) 



or, in terms of distance 



GS\aI = 




( 2 . 10 ) 



Some typical values for GSW are shown in Table II . 
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1 

TABLE II 

GSW as a Function of Altitude 



h 




e 


GSW 


150 


nm 


33. 2° 


1995 


nm 


600 


nm 


63. 4° 


3796 


nm 


2250 


nm 


105. 6° 


6338 


nm 


5600 


nm 


135.3° 


8113 


nm 


10900 


nm 


152.3° 


9136 


nm 


1S322 


nm 


162.7° 


9760 


nm 


CO 




180 ,J 


10300 


nm 



The second aspect of swath width is minimum swath width 
(LIS ) required for coverage, as a function of the number of 
revolutions per day. Because the swaths cut by a satellite 
in a circular orbit are most widely spread as it crosses the 
equator, this simply means computing n, the number of 
equator crossings per day, and tnen swath angle is defined 
as 



where 



©s’ / v\ (2.11) 

WR.S 54AGU- O v\w\ 

a '' ('TrV^ " ' 



SO 






(v.o 



05 >~IO 




( 2 . 12 ) 



Taking into account both the ascending and descending 
trajectories, the typical satellite orbit can actually be 
considered to cross the equator twice per revolution (see 
Figures 2.3 and 2.4), and so is a sufficient swath 

width to ensure coverage along the entire equator, which is 
of course a worst-case approach for achieving coverage of 
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the entire globe. This leads to the information summarized 
in Table III; the last (geosynchronous) case is obviously 
unrealistic for tracking applications, as HSK is greater 
than GSW. 



TABLE III 

MSW as a Function of Altitude 



h 

1 50 nm 
60 0 nm 
2250 nm 
5600 nm 
10900 nm 
19322 nm 



n 






MSW 



16 

13. 

8 

4 

2 

1 



4 1 



11.25 

13.47° 

22.5° 

45" 

90° 

180 



675 nm 
808 nm 
1350 nm 
2700 nm 
5400 nm 
10800 nm 



The overlap, or difference between Tables II and III, 
determines the maximum number cf times a single satellite 
can possibly view a stationary target on the equator during 
successive orbits. This number N can be calculated by 
dividing twice equation 2.10 by equation 2.12, or 

x-v/nn ~ 1 ^‘ 2_ 

Unfortunately, average time between revisits cannot be 
characterized as 24 hrs/N, as successive swaths will overlap 
on consecutive orbits, and then the target will not be illu- 
minated for several orbits. At this point it is necessary 
to place additional satellites in the orbital pattern, or 
constellation, to ensure coverage during every orbit, i.e. a 
minimum of 360/GSW (rcunded up) is required. This will then 
provide n visits per day to the equatorial target, where n 



Nl - 



A CO'j' 



tr V\ 



\.o5 a-icT* * 
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is again as defined in equation 2.11 . Once this has been 
achieved, insertion of additional satellites will only 
continue to increase the revisit frequency while correspond- 
ingly decreasing the revisit time. 

The last factor in this revisit time problem is the 
consideration of hor izon-to-hor izon coverage along the path, 
that is, until now the discussion has only dealt with meas- 
uring the time between successive CPA's (Closest Point of 
Approach) of the satellite to the target. As Figure 2.7 
indicates, however, the target is actually in view icng 
before the satellite passes overhead, and remains in view 
until the satellite passes over the far horizon. 




Figure 2. 7 Target Time-in-7iew for a Single Pass 



If the target lies directly on the satellite’s path, 
then the maximum viewing angle is defined in Figure 2.3 
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Figure 2.8 Viewing Angle 



This translates to a 



T 



T. 

* 3<uO 



viewing tine of 



7-a 




1 G.NV 


Vtc 



Foe a surface target and a satellite at 150 nra elevation, 
this translates to a time-in-view of 8.3 minutes. This 
viewing time will increase as satellite altitude increases, 
and decrease as the target moves toward the outside of the 
swath. Regardless, the revisit time between target observa- 
tions is always decreased by this viewing time. 

The final facet of ground coverage to be considered is 
coverage at the poles. Having used the Equator as the worst 
case for swath spreading, one might then expect the swaths 
to converge at the poles. Actually, the convergence of the 
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ground track occurs about the latitude lines of the angle of 
inclination because they are the circles of smallest circum- 
ference to be viewed from directly above; hopefully the 
swath width of the satellite is then great enough to overlap 
the poles. Thus for an orbital inclination of 60 degrees, 
the most closely grouped locus of points observed from 
directly overhead are the latitude circles 60° N and 60 u S. 
To see if the swath overlap will at least cover the poles. 
Figure 2.9 must be considered. ^/i_ is the half-angle from 
equation 2.9, so 



Table IV summarizes these results for typical orbital 
heights. 




Figure 2.9 Hinimum Inclination for Polar Coverage 




or 
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TABLE IV 




ainimum 


Inclination for Polar Coverage 




h 


i 




150 nm 


73.4° 




600 nm 


53.4 ° 




2250 nm 


37.2 ° 




5600 nm 


22 .4 « 




10900 nm 


13.9 ° 




19322 nm 


8.7 ° 





To summarize thus far, a satellite placed at an altitude 
of 600 nm would be useful for tracking purposes; its GSW of 
63.4 and MSW of 13.47 ensure that a target would be viewed 
on at least four (and probably five) consecutive passes, and 
its crbital period of 107.4 minutes indicates that the 

target would be viewed frequently enough to acquire timely 
and significant information about its location, course, and 
speed. Inclining it a minimum of 58.4 degrees would ensure 

coverage of both poles, and its precession rate of -3 

degrees per day (or about -0.2 degrees per orbit) would not 
deter its ability to maintain track on the target. 
Realistically, a single satellite would not be used; the 
placement of a minimum of six in the constellation would 
ensure that no target would go more than one period without 
being observed, and the placement of additional satellites 
would only then increase the frequency of target 

observation. 

D. SATE1LITE ORIENTATION IN SPACE 

Having developed a working model for the orbiting satel- 
lite, the next phase cf the problem will consider the satel- 
lite's observation of its target, either by passive (i.e. 
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IP.) or active (i.e. search radar) means. First, however, a 
coordinate frame of reference for that observation is 
required. Thus far the assumption that the satellite can be 
represented by a point mass has sufficed; now, however, it 
must he realized that the satellite has dimension, is irreg- 
ularly shaped, and quite possibly undergoes radical attitude 
changes throughout the course of its orbit. It is therefore 
imperative that the satellite be able to orient itself with' 
reference to its ground point, that is, the point on the 
Earth's surface directly between the satellite and the 
Earth's center. This is because, realistically, the satel- 
lite will be measuring (at best) a line-of-sight range and a 
series of angles (probably altitude and azimuth) to the 
target: it is these angles that must be oriented with 

respect to the reference directions, in order that the data 
fed to the tracking computer be consistent. 

In considering Figure 2.10, Figures 2.10 (a) and 2.13 
(e) show the space reference orientation and the satellite 
aligned in that orientation; Figures 2.10 (b) , (c) , and (d) 

show the initial position and intermediate rotations of the 
satellite axes required to achieve that orientation. It 
should be emphasized that these rotations are computational 
rather that mechanical; as long as the target falls within 
the sensor's coverage area, there is no need to actually 
physically rotate the satellite into any new position. 
Rather the target coordinates are transformed mathematically 
as follows: 

Step 1. Rotate around the x axis by ' \\ to get y axis 
into "NE" plane. 
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Figure 


2.10 Translation of the Satellite 

To the Reference Orientation 


Step 2. Rotate around the 
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axis by ' to get 


axis in the "D" 


direction. 
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Step 3. Rotate around the z axis by t< 

y axes aligned in the 

r 



T = 



"N" and "E" 


directions . 
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get the x 



Thus to get from x-y-z coordinates to N-E-D coordinates, the 
transformation is 




T; XT 



r — T 



X 






(2. 13) 
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Figure 2.11 Angles Transformed to Rectangular Coordinates 

There is actually another step involved both before and 
after the transformation of eguarion 2. 13, that of trans- 
forming from the angles to the rectangular coordinates and 
back. The translation from an initial set of raw angular 
measurements to the satellite's x-y-z rectangular coordi- 
nates is shown in Figure 2.11 . The corresponding equations 
are 



3 3 



~ \2- s > Ni t ^ >. ^ 

^ ^ Sv.-oy^ 'S'ni ?L, 

^ ^ <-o* /o • (2. 14) 



Meanwhile, the transformation from the N-E-D reference 
rectangular coordinates to the observed angular coordinates 
is depicted in Figure 2.12, and described mathematically by 



&O E" 1 * V-’ 
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0( ' TkN~ v ^ / M 

> 

^ - co.-r' ^Rs c 



(2. 15) 



It is worthy of note that R remains unchanged by all the 
transf ormations ; only o( and g change. Thus the complete 
transformation from ang les-ref erenced -to-sa tellire to 
angles-referenced- to-ground is 
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Figure 2.12 Rectangular Coordinates Transformed to Angles 




Figure 2. 13 Observing the Target from Space 

E. SATELLITE OBSERVATION OF A NEAR-StJRFACE TARGET 

Eguations 2.16 detail the realignment of raw target 
information along the space reference axes, li-E-D ; the 
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Figure 2.14 Satellite- Target- Earth Center Triangle 



final step in calculating target position and velocity on 
the Earth’s surface is to translate the range and the space 
angles into earth’s surface coordinates, i.e. latitude and 
longitude. Figure 2.13 shows the pertinent variables, while 
Figure 2.14 shows the triangle formed by the satellite, the 
target, and the earth’s center. The latter figure presumes 
a surface target; the case of an air target will be 
discussed momentarily. 

To find the earth’s surface distance along a great 
circle passing through the ground point and the target’s 
position, one need only find the earth-central angle with 
the law of cosines, as shown in Figure 2.14 , 






- COS 



C " + ( ' r » T V\ s ^ — 



{2. 17) 



and then the arc length, or surface distance 
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Figure 2. 15 Same Triangle for an Air Target 



Note that the angle was not required in this calculation; 
it is required, however, for calculations involving an air 
target of unknown altitude, as shown in Figure 2.15 Solving 
for the target height requires applying the law of cosines 
again : 






(So T 
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R (' 0. ’ W) Co'S, ft 
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(2. 18) 



an d 



t hen 



/> 



follows from the law of 



sines : 
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(2. 19) 



and once again. 



<x = - 



In either case, cnce the great circle distance from the 
ground point to the target is known, the target’s latitude 
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Figure 2.16 Surface Triangle for Target Position 

and longitude may be calculated by using the spherical 
triangle shown in Figure 2.16 . Using the law of cosines 

for spherical triangles, and realizing now that it is actu- 
ally more convenient to work with earth-central angles 
rather than great circle distances, then 

(Toi ( c io -Lt) - cos ( CoS^// r SvN ( c Vg-L-s) "Sid/? cK t 

or, equivalently. 




Similarly, 




cr, solving for }L 




( 2 . 22 ) 
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and finally 



L- \ 



[ 2.2 3 ) 



It should be emphasized that both latitudes are referenced 



latitude and/or west longitude, one need only know 

For N Lat < 0, S Lat = -N Lat ; 

For E Long < 0, R Long = -E Long; 

For E Long > 180, W Long = 360 - E Long . 

Sample calculations using these eguations reveal that it 
takes a significant amount of target elevation to generate 
an appreciable change in /o , i . e. at a range of 1000 nm from 
a satellite at elevation 600nm, a target flying at 25000 ft 
would have a fi angle only 0.2 C different from that of a 
surface target. Therefore, depending on its sensitivity, 
the satellite sensor may or may not distinguish betwen 
target types, if dependent ce a single look at position 
only. The necessarily greater speed of the air target, 
however, will ultimately become obvious if the satellite 
system is either capable of calculating range and bearing 
rates based on multiple observations, or else rate informa- 
tion is an intrinsic part cf the single observation. 
Therefore, this model must provide for the satellite’s 
ability to observe R , oL , and in addition or as opposed 
to R , oC , and . The transformation equations 2.14 through 
2.23 must then be differentiated with respect to time to get 
the range and bearing rates referenced to N-E-D, and then 
the target's latitude, longitude, and altitude rates. 

Differentiating eguations 2.14, 



North here, and both longitudes East. To switch to south 
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This gives rate of change of the target’s coordinates 
referenced to the satellite's axes and based on the target's 
motion; if the satellite can instantly fix its position in 
space, then x-y-z can be transformed to N-E-D by applying 
the transformation equation 2.13 to correct for satellite 
attitude. If the satellite's own rate of rotation around 
its three axes is taken into account, however — i.e. the 

satellite is tumbling fast enough to affect significantly 
the observed angular rates--then that transformation 2.13 
must also be differentiated, i.e. 
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(2. 26) 



40 



Having transformed the raw rate data to the reference coor- 
dinate rates with equations 2.24 through 2.26, these rates 
are then translated to earth’s surface coordinates by 
differentiating equations 2.17 through 2.23 . 

Then, from 2.17 (surface target). 







(2. 27) 



from 2. 18 , 




(V»-vV\s^ cos /&) + ^ ^ S V M /I 



*i T ' Wj- 



(2.23) 



from 2.19 (air target), 

<• C^c'^x) t Q-ficCife J- R.Ut 

- h — ^ 

(<.->• V\r)' C o 'yO 

and in either case, tJL - cy3 . 

From 2. 20 , 

- — 1 ccy - 

V y coy/ ccs X. — L<, S<n y 



(2. 29) 



(2. 30) 



and from 2.21 through 2.23 , 

O-Tt-i-X'. rl.J \ CcSl T S|.oC; - i'CC,- CC^CoX 

1 CoiC T Cj~„ (.> I 7 L 

-^S 

These equations 2.24 through 2.31 completely define the 
derivation of target latitude and longitude rates based on 
raw angular and range rate data available at the satellite. 
If applied sequentially by a computer, the target’s rate of 
travel could easily be calculated. 



l : 



^S»\;L T COS^s ~ Co A Lt CCS7C 
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t X s . (2.31) 



This completes the description of the recorded data 
available from the orbiting satellite and its observation of 
a near-surface target. The next chapter is devoted to 
reconstructing the target's motion from this information; 
this will then lead to the observability analysis of Chapter 
IV. 
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III. TARGET MOTION 



It is henceforth assumed that the satellite's position 
and orientation in space are known, and thus observed target 
data can be translated into ground coordinates in accordance 
with the discussion presented in the last two sections of 
Chapter II. This leaves the problem of reconstructing the 
target's motion from the observed data. With an eye toward 
the observability analysis upcoming in Chapter IV, an effort 
will be made to employ a linear target model, while the 
observations will be necessarily highly nonlinear. The 
alternatives would be nonlinear equations describing Loth 
the target's motion and the observation, or a nonlinear 
plant with a linear observation achieved by another coordi- 
nate transformation, both of which would only further 
complicate the problem at this point. They do present 
viable possibilities, however, which might be investigated 
as part cf a search for convenient coordinates conducive to 
appropriate nonlinear observability analysis and tracking 
design. 

A. TARGET MOTION RECONSTRUCTED FROM SATELLITE DATA 

In Chapter II, algorithms were developed for trans- 
forming raw satellite sensor information into ground coordi- 
nate data; given range and bearings, the computational 
result is target latitude and longitude. If range and 
bearing rate information is also available, the result is 
then latitude and longitude rates. 

To reconstruct the target’s motion from this information 
is fairly straightforward. The first step is to translate 
the latitude and longitude into linear distances, and then 
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Figure 3.1 Earth’s Surface Projected onto Cartesian Grid 



compute the velocity components if they are not readily 
available. If the earth’s surface is projected upward onto 
a Cartesian Grid with its origin at (L, \ ) = (0,0) as in 

Figure 3.1, then a position (n,e,h t ) would be described by 
equations 3.1, with h 7 unchanged from Chapter II. 

n - U 



e - V 0 \ T CoqL T 



(3.1) 



If rate data is available from the satellite, then the 
northerly and easterly velocity components are computed 
simply by differentiating equations 3. 1 with respect to 
time; obviously, h.,. is once again as in Chapter II. 
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= V, U T 

r . 

- ■£ - Vo Co'iLx — AtLtS(niLt 



(3.2) 
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On the other hand, if rate data is not immediately avail- 
able, the next position observation is required, and the 



; at time 


k are approximated by 


v„ av 


'T 


LA - 






T 


A LA - 





(3.3) 

in either case, then veloci 

and course ^ tanj 

as shown in Figure 3.2 . For ar. aircraft flying at constant 
altitude, h T will be zero; for a surface target, both h T and 
h T will be zero. Otherwise, this first-order model allows 
for nonzero velocities in the n, e, and h T directions. To 
avoid the necessity tc include any higher order variables in 
the target description, the model will represent accelera- 
tion as the control vector u{t) in all further discussion of 
the target’s performance. 

B. SATELLITE DATA OBSERVED FRO H TARGET aOTIOH 

Thus far, the result of the discussion in Sections IID, 
HE, and IIIA of this report effectively has been to develop 
an algorithm for describing the motion of a near-earth 
target, given the parameters of the orbit of the tracking 
satellite and the observed target data. No matter what 
method of analysis is employed, however, any observability 
study requires first a target model, and then some series of 
observations based on target lehavior; therefore it now 
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Figure 3.2 Resolution of the Velocity Components 

becomes necessary effectively tc work backwards through the 
equations of those three previous sections and develop a 
system of equations that feature the target as the plant and 
the satellite as the observer. It would of course greatly 
facilitate the observability analysis if both the plant and 
observer for the system could be linear, and take the form 

x(t) = A x ( t ) + Bu (t) , 
y(t) = Cx(t). 

In that case, the observability study of Chapter IV would 
become straightforward, and this aspect of this problem 
would no doubt have been fully explored years ago. 
Unfortunately, as the complicated angular rotations and 
spherical geometry of Chapter II portend, there is no real- 
istic way to pick variables sc that the problem will be 
fully linear. It remains then to experiment with either a 
linear plant and nonlinear observer, or vice versa; it would 
ultimately be advantageous to avoid if possible the 
completely nonlinear system described by 

4<t) = F {x (t) ,u (t) ,t) , 
y (t) = H (x (t) ,t) . 
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Now, the discussion of Chapter II essentially derives 
the system equations for describing a target’s motion in 
terms of space coordinates; however, to have a near-earth 
target described in terms of E, ol t St and their deriva- 
tives would not necessarily be useful, as it would require 
all the coordinate transformations of Chapter II to be 
performed over again to relay any useful information to the 
ground. In addition, the presumption of a constant (in the 
absence of control input) course, speed, and/or rate of 
climb (air target) would be mathematically impossible, since 
these coordinates would not be available; therefore, since 

o 

assuming constant R , , and would still not achieve 

constant V w , V £ , and h T , the second derivatives of R, .x , 
and $ would be required, i.e. the differentiation of equa- 
tions 2.24 through 2.31 . To avoid this unnecessary compli- 
cation, the reverse derivation will be performed here, i.e. 
a description of both target motion and space observation in 
terms of earth's surface coordinates. The model will be 
derived for the most general case, i.e. all variables non- 
zero. The constant altitude aircraft or surface target will 
be considered simply to be special cases of this. 



1 . Tar get Model 



If the target is presumed to maintain a 
course and speed in the absence of a control input 
ation) , a simple one-dimensional model might take 
of 
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const an t 
accel er- 
the form 



where u (t) can actually be either system noise or an accel- 
eration. Since three mutually perpendicular coordinates are 
required to describe the target position, the system should 
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have six state variables, defined by the quantities devel- 
oped in Part A of this chapter as follows: 



x, = n = northerly distance traveled (nm) , 
x r = n = V u = Vcos4> = northerly velocity (kts), 
x j = e = easterly distance traveled (nm) , 
x A = e = V; = Vsinc|> = easterly velocity (kts) , 

x f = h-j= altitude above earth’s surface (nm) , 

♦ 

x t = h-r= rate of climb (kts); 



and negative values for these variables represent southerly 
distance, southerly velocity, westerly distance, westerly 
velocity, (no negative altitude) , and rate of descent, 
respectively. For a surface target, x 6 - and x 0 are zero; for 
a constant-altitude air target, x, is zero. The target is 
thus modeled continuously by 
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(3.4) 



where u (t) represents either noise in the n-e-h. T system, or 
else acceleration in the three directions. Realistically, 
because computation requires a finite time and one satellite 
cannot normally be dedicated solely to observing a single 
target, the observations will necessarily be discrete, and 
hopefully periodic in time T. The discrete model analogous 
to that of equation 3.4 is 
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(3.5) 



48 



Assuming that external nonlinear forces such as wind or sea 
drag are either negligible and/or unpredictable, this 
completes the target model. 

2 . Sa telli te Obse rvati on 



The observer matrix H will obviously be a nonlinear 
operator on the state vector. To begin its derivation, the 
n-e-h._ coordinates must be transformed to latitude- 
longitude-altitude coordinates by solving equations 3.1 in 
reverse , and then differentiating as follows: 
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(3.6) 



The ultimate goal of this transformation will be to express 
the space observations in terms of the state vector, i. e. 
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First, however, it is useful to calculate in ter 
state vector the intermediate variables ?£. and yO , 



were defined in Figure 2.16 
trivial : 



Solutions for 
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To solve for and , equation 2.21 is rewritten 

follows : 



as 



CcS^ = Stvi Uj 5.,vi L s -t cos V-t ccStl, 



(3.9) 



and then - - l_y ( Cost-* - <>vmLt Cosi^c^Tt^ 

VL° S (svML-t to^t; - Co* L- SimL s Coy?e) -?t ccSL t cosL s S'^?c, 



or 
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, NJ 



vL S ^«wts CoS-TC - Sr>iL T Co3L s ^ x.cc,SL t CoS^Sir^. (3. 10) 

Enough information is new available to solve for the 
space coordinates R , Oi , /3 / and their derivatives. To 
obtain R, the law of cosines is applied to Figure 2. 15 as 
follows : 

R ' Gf* * ^ £v„r U^»( Ur\ CcS/? ^ 



so 
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To obtain R, consider 
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(3. 12) 



To obtain C>1 , the law of sines for spherical triangles is 
applied to Figure 2.16 as follows: 
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To 



or 



obtain c4 , consider 




To obtain /o , the law of cosines is again applied to Figure 
2.15/ this time yielding 
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(3. 15) 



/4 = CCS"' 

To obtain ^ , consider 

- s< ^ |V* C^X- (owY ^(.oyJ, 



or 




3fc(r,Lhv; -R R = -Cr,.U i Y,ty 

2 ^ £<V-W) *s«^ 




(3. 16) 



The observation model is summarized in Figure 3.3 . Any 

realistic computational procedure would of course use the 
intermediate variables L, A / 7C , , and their deriva- 

tives; for the sake of completeness/ however, it should be 
noted that the observer functiors could be written as func- 
tions cf the original state vector. 
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Figure 3.3 Suuuary of State and Observer 
Equations Including Intermediate Variables 
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3. 



Tw o Simjoler Ca ses 



The significant complexity of these equations 
suggests that some simpler representation of the system 
might he useful in the obser vatili ty analysis, if only to 
test the method prior to its employment on the system of 
Figure 3.3 . One approximation might be to presume for the 
moment that the satellite is directly overhead the target, 
and that relative motion between them is arbitrarily small 
enough that the Farth is approximately planar beneath it; 
for the trigonometric functions, 

“uW/5 = Sw/2 = and ccS^i. 
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Figure 3.4 Satellite Directly Overhead the Target 

If one considers that f cr a satellite directly over- 
head the target as shewn in Figure 3.4, 

It* U, X T ■=- As , and h T = lv s - ft . 
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Figure 3.5 Perturbation About the Observation 
From Directly Overhead 




Figure 3.6 Resolution of Beta Along the N-E Axes 

then fcr a satellite nearly overhead the target, the probxem 
can be considered as a perturbation about the directly over- 
head case. In Figure 3.5, let 
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(3. 17) 
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To fully linearize the problem , it turns out that ^ must 
be eliminated; this can be done (in this special case only) 
as shown in Figure 3.6: 
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Now the observation may be defined by 
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and the corresponding discrete system plant is 
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( 3 . 21 ) 



with the same observer matrix as above but with values taken 
only at discrete points in time. 

Experimental computations show that for a satellite 
at altitude 600nm and a target at less than 60 1 ' latitude, 
these approximations yield about one percent error or less 
for less than 5°; however, the maximum possible over- 

head time during which this model applies is about 20 
seconds. It follows then that this sort of observation 
could only be made a very few times during the satellite’s 
revolution, severely limiting the real-world usefulness of 
this linear model. For the purpose of examining the observ- 
ability of the target under these conditions, however, the 
model should still prove quite useful. 

The other simplified model that might be instru- 
mental in gaining some insight into the method of the 
observability analysis is the simplest nonlinear case, i.e. 
the satellite tracking a fixed point on the earth’s surface. 
Simplifying the equations 3.5 through 3.16 yields the system 
depicted by the equations in Figure 3.7 

This completes the various derivations for all the 
target models. 



56 



m 

- " le 1 



L 



CoS 





: v\ 


AS 


v\ 


o 




W= VI , 


r. 

h 

0 




\ - ^ 

At r u ccs n 


, £*o 




74 - \ T - X 4 


, 7C - X, 


-K 


"S V M L- S\mL$ 


+ CoS Lj CcSLj 






Q (cost* 5v-vjL T CciL s ) *X Cc* Lf Cio U 'iv.'OtT^ 



U v -- <L - C'f.’ UsV— C^-rV*^ coy^} 



Wi, - d - 



Hj - 



/? r o l^W") Swv J/9 

£s 



SvM 






Co S' Lt 



-7 



S t»Nl 



'/ 



— t>4 - 



Mr " / = 



w t •- ^ - 



?t 



6 1>< vy? C.-S Lj CC-'jX — CC ^M 
CGi t4 S i.V^? 



CoS 



P' 2 -'- (v^u.y- r c 



'2. «-(.*;+ 

-« [r^-v r^-C^rWr] 

"2- <2- ( S v.-vj jO 



Figure 3.7 Eguations for Tracking a Fixed Target 
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IV. TARGET OBSERVABILITY 



This Chapter is subdivided into three major sections, 
specifically the observability analyses of the three 

different target models developed in Chapter III. First, 
the linearized model will be analyzed by the method of 
[Ref. 2], and then the stationary target and the general- 
case, nonlinear, moving target will be analyzed by the 

method developed in [Ref. 1 ]. 



A. OBSERVABILITY OF THE LINEARIZED MODEL 



For convenience 1 sake, the linearized model has been 
subdivided into four cases, nanely surface and air targets 
with discrete and continuous modeling for each. The method 
of [Ref. 2 ] is the formation of the observability matrix G, 
from the system 

x = Ax + Bu 
y = Cx 

such that G - \ CP. f\ T C T < fC* C \ (C Pi 

for n observations, and for system observability, G must be 
nonsingular. In the following derivations, the minimum 
amount of information necessary for obser vability is 
considered. 

1 . S urfa ce Target Continuous Model 



The system model is 
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For a single look. 
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For the next observation, A = 0, so there is no need to 
take the process any further. If only position observ- 
ability is desired, rather then full state observability, 
then 

'A 



4 = 



A 



is enough even for only a single observation. 
2 • Surface Ta rget D iscret e Mode 1 
Now the system model is 
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For two or more 



is required, 
looks , 



and G 
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which simplifies easily to the same nonsingular matrix 
obtained in the analogous continuous case. 

Obviously for this simplified case, the transition 
from continuous to discrete modeling made no difference; it 
has been implicitly assumed that the discrete samples are 
taken often enough that all maneuvers (i.e. accelerations) 
are observed, in accordance with the Sampling (or Shannon 
Information) Theorem familiar from communications applica- 
tions. Otherwise, observability will decrease significantly 
as information about the target is lost. 



3. Air Tar get Continuous Model 
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is required, and G = C as in the surface target cases. For 
two or more looks, 
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for complete observability. As in the surface case, if only 
position observability is desired, then 
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is adequate even with only the single observation. 
4 . Air Target D iscrete Model 
The model has now become 
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For two or more 



is required, and as expected, G = C* again, 
looks , 
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which simplifies 
continuous case. 



to the same ronsingular matrix as in the 
Again, the assumption has been made that 
information is sampled at the minimum (i.e. llyquist) rate, 
which is twice as often as the target’s highest frequency of 
mane uver. 



B. HCN1IHEAR MODEL OF THE STATIONARY TARGET 
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briefly, concerns 
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the analysis of a Jaccbian 
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for each observation of an n-system. A nonzero determinant 
will show that all the states ir. x are connected to at least 
one of the measurements y, and so an inverse function exists 
such that 
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x = H (y) . 



For observability, however, this mapping of y back into x 
must be one-to-one, so that a particular series of measure- 
ments y will always determine a unique initial state x (t u ) . 
This requirement is satisfied if a second condition is met, 
i.e. J must be positive or negative definite, and the 
mapping unique with finite covering. The complete proof of 
these concepts is presented in [Ref. 1] and [Ref. 7]. For 
multiple observation variables (i.e. numbering m) , an n x mn 
matrix is formed; if any n x n matrix can be extracted that 
satisfies these conditions, the system will be observanle. 
For the six- variab le, six-observation case upcoming in 
Section C of this chapter, this will lead to a great many 
possibilities and problems, but for the two-variable case of 
this section, the method should prove very useful. The 
approach will be to first consider each observation sepa- 
rately, and then in combination. 

Starting from the equations for the observation of the 
stationary target depicted in Figure 3.7, derivation of the 
Jacobian matrix for y = R is accomplished by means of 
implicit differentiation alone the lines of functional 
dependency depicted in Figure 4.1 . Consider 
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Figure *1.1 Functional Relationship of R and R to n and e 



Thus the Jacobian matrix for R is written 
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the determinant results in 
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which is obviously nonzero in the general case but may well 
have multiple solutions. Based on the criteria just 
defined, this indicates that bcth states in x are connected 
to the observation R, but the connection may very well not 
be one-to-one; some further analysis is obviously reguired. 

The determinants of the J-matrices for each of the other 
observed variables may well prove similarly ambiguous; 
considering the observed variables in combination and 
attempting to establish nonsingularity and positive/negative 
definiteness of the resultant myriad of Jacotians may well 
prove difficult in the extreme, if only in the sense of 
requiring a copious amount of confusing algebra. While the 
basic geometry of the problem as developed m Chapter II 
leads one intuitively to the conclusion that a surface 
position can be uniquely established if either ( oC , yS ) or 
(fi t (X. ) ~~but not (R,yd) — data are available, demonstrating it 
by this method proved a mammoth computational undertaking. 
Needless to say, when the problem is expanded to the four 
variables of the moving surface target and then the six 
variables of the air target, the algebra worsens several 
times over. The only alternative seemed to be a transforma- 
tion of coordinates, specifically to a rectangular system, 
so that the differentiation could include some polynomials 
instead cf only trigonometric functions. The transformation 
is accomplished as fellows: establish a plane at a distance 

equal to (h s . -h T ) below the satellite perpendicular to the 
vector connecting the satellite to the earth’s center, 
determining in effect the target’s horizon. For a surface 
target, the point of intersection is the satellite’s ground 
point; for an air target, the intersection is h above the 
ground point. Then the target's position is projected up 
into the tangent plane, as shown in Figures 4.2 (a) and (b) . 

It is now possible to establish the relative coordinates as 
follows: 
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Figure 4.2 Projecting Target Position 
Into a Perpendicular Plane 

As every set of true target coordinates yields a unique set 
of relative coordinates for a particular satellite, the 
mapping into the Cartesian coordinates is one-to-one, and an 
observable target in one svstec will te observable in the 
other. The complete set of state and observer equations in 
this coordinate system is as illustrated in Figure 4.2 (b) 
and summarized in Figure 4.3 . For the special case of the 
stationary surface target, the system simplifies as follows: 
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The plant equation is unchanged, and the observations are 
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Since only position is of interest, the Jacobian matrices 
will be 
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Figure 4.3 State and Observer Equations 
For the Cartesian Version of the Problem 

l 3 A - X 

*/\ s (w-L^ccsts •+ l°s ( ( U-t-^S'-^s ; (4 * 2) 

which is again nonzero in the general case, and which will, 
on reflection, lead to a unique solution for any particular 
target and a specified satellite; in fact, equation 4.1 
should then also yield unique sclutions, not just due to the 
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one— to— one correspondence of the coordinates and the observ- 
ability problems, but also due to the physical reasoning 
illustrated in Figure 4.4 . 
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Figure 4.4 Tracking the Stationary Target 

The satellite’s ground track is a curve, and there is 
only one possible point of intersection of even three 
circles whose centers lie upon it. This observability will 
be more clearly demonstrated if the single observed variable 
to the stationary target is ; obviously, the intersecting 
lines of bearing must define a single point. Further, since 
for a surface target every R defines a unique and vice 
versa, the A -only case should he observable also. 
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(4.3) 
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The numerator is identical to that of the 
Figure 4.5 illustrates the situation here. 
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Figure 4.5 Azimuthal Bearing-Only Track 
Of the Stationary Target 
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So again the same form of determinant will be achieved, 
albeit with a different multiplicative constant. Thus for a 
target known to be stationary, the observation of any of the 
quantities E, OC / or ft is enough to fix its position. 
Presumably the same result could have been achieved in the 
original coordinate system had the algebra been carried 
through. 

C. HCH1INEAR MODEL OP THE GENEIAL TARGET 

Once the target is permitted to move, of course, the 
unique- intersection arguments just developed no longer 
apply. The equations shown in Pigure 4.3 now are pertinent, 
but J is defined by 
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The derivation of the Jacobian matrices and their determi- 
nants is now a major project in itself, but it follows the 
same pattern previously established. In the interests of 
brevity, the requisite algebra is excluded from this discus- 
sion, but included in this report as Appendix A. After 
simplification by row reduction, the J matrices are as shown 
in Figure 4.6 , with the JL and H' terms as specified in the 
appendix. Further simplification of the determinants may 



well be possible, but these representations should suffice 
here. It is obvious from the occurence of the zero rows and 
columns that all the determinants excluding those of J ( - and 
J u are zero; computation of these last two determinants 
proves them to be zero also. Considering the observed vari- 
ables in combination, it would seem that some variable in 
addition to R or R is always necessary for obser vability, as 
they have the only Jacobian matrices with zero rows. While 
the possible combinations of six columns out of the thirty- 
six are so numerous {approximately two million) that it is 
virtually impossible to explore them all, only one combina- 
tion with a nonzero determinant and positive or negative 
definiteness is required for observability. 

What one would expect, based on the insight gained in 
Chapters II and III from the mathematics of the derivation 
of the model, is that any combination including oi or U and 
at least one position variable {i.e. R and <x , oC and ft , 
etc.) should be observable, and that any determinant formed 
from a combination of columns from the appropriate J 
matrices should prove it (excepting of course the zero 

<9 

columns in the oi and oi matrices). The combinations of 

y # 

E, R, ft , and ,4 should however prove unobservable for the 
reason of a lack of positive/negative definiteness, that is, 
an ambiguity of target track resulting when reconstr uction 
of the initial state is attempted from the measurements. To 
prove this condition true for each of the approximately 
130,000 possible matrices is however obviously an unreal- 
istic undertaking. 

One slightly simpler case cf particular interest might 
be that of the surface target, which involves the first four 
rows by four columns in each matrix. If the accelerations 

o 

are ncnzero, all the Jacobians except R have nonzero deter- 
minants. The R , , ft , and ft determinants are not posi- 

tive or negative definite, indicating that there is still 
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Figure 4.6 Jacobian Observer Matrices 
For the Six State Variables 
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some ambiguity in the observations and so the target is not 
observable. In the case of the o( Jacobian, however, it is 
positive definite, i.e. the JL terms drop out and 

1 — 

\3 \ - (e.a,-na £ ) (4.5) 

This indicates that a maneuvering surface target is observ- 
able when azimuthal hearings only are observed; this case 
corresponds very closely to the two-dimensional bearing-only 
tracking problem long familiar to submariners. If the target 
does net maneuver, then the U. Jacobian becomes non- 
singular and the target is unobservable, and then more than 
one variable of observation, to include or ^ , is 

required for observability. 

It becomes obvious why the observability of nonlinear 
systems has long been considered a highly difficult problem. 
At least as much insight was gained into the problem from 
its mathematical derivation as from the application of this 
method of observability analysis. One area in which the 
method might also be useful is in evaluating the sensitivity 
of the system observability to fluctuations. Specifically, 
the terms in the Jacobian are each smaller than the x or 
R terms by a factor of 1/jn^+e x , which would, in the general 
case, mean a difference of three orders of magnitude. This 
would certainly lead cne to presume that the system would be 
more sensitive to fluctuations in than in R or ^ • 

To summarize thus far, the geometric derivation of the 
coordinates in Chapter II leads one to believe that ail 
three coordinates R , oC , and p , or the derivatives of no 
more than two of them, are necessary to reconstruct the 
target motion in the most general (air target) case, while 
either the (R,o^ ) or ( oi , /3 ) combination is necessary and 
sufficient for the surface target. Examination of the 
linearized model in this chapter tended to validate those 
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insights; then the examination of the stationary surface 
target led to the coordinate transformation, and to the 
conclusion that any position variable of observation would 
suffice for observability of this type target. 
Consideration of the general target model showed it to be 
unobservable for any single variable of observation, and 
then a brief examination of the moving surface target led to 
the important conclusion that ar. -only track is possible, 

at least if the target maneuvers. Further, it appears that 

the system is far more sensitive to fluctuations (i.e. 
noise) in the $ measurements than R or <X • In Chapter V 
some cf these perceptions will he tested by the designing of 
a deterministic nonlinear observer and then tracking the 
target with an EKF. 
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V. FILTER ING AND TRACKING 



The objective of this chapter is to apply the results of 
Chapter IV. Specifically, this will entail designing a 
deterministic nonlinear observer, and then an EKF, in accor- 
dance with the methods discussed in [Ref. 3] and [Ref- 8]. 
The original coordinates of the problem as developed in 
Chapters II and III will be employed, rather than the 
rectangular coordinates of Chapter IV. 



A. DETERMINISTIC NONLINEAR OBSIRVER 



Actually, in [Ref- 8], Kirk only discusses the design of 
linear observers, but by employing the now-familiar tech- 
nique of linearizing about an estimate with a first-order 
Taylor Series expansion, the technique can readily be 
extended to a nonlinear system. Some alternative methods of 
nonlinear observer design are discussed in [Ref. S], 
[Ref. 10], [Ref. 11], and [Ref. 12]. 

For the system under consideration. 



a 

x = Ax + Eu , y = H(x) (5.1) 

where 
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Assuming an observ er-es tima ted trajectory x, the observation 
is linearized around it 
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°S ' hi (_X-X) v o£U^jyZ- t (5. 
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Figure 5.1 Plant and Observer for the General System 

Ignoring the higher order terms and assuming for the moment 
a constant velocity target, the linearized system can new be 
described by 



x = Ax 
/ 



(5.3) 
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v\ci\r 



(5.4) 





Now, since the method of [Ref. 8] assumes that only the 
measurements v are available, the plant matrix must be simu- 
lated by the observer to generate successive estimates, i.e. 



x 




(5.5) 



However, unless the estimates are coincidentally initialized 
to values identical to the initial conditions of the actual 
system, there will be an inherent propogation error. 
Therefore a correction term must be added to equation 5.5 as 
follows : 

x = Ax + G(H(x) - H(x)) y (5.6) 

where G is the observer gain; the determination of G will be 
discussed shortly. Equations 5.1 through 5.6 can be illus- 
trated by the block diagram of Figure 5.1 . 

To evaluate G, the first step is to substitute equation 
5.4 into equation 5.6 so that 



£ - Kx 



•+ 







It becomes useful to define the error in x as 



(5.7) 



X 




(5.3) 



x is defined by subtracting equation 5.7 from equation 5.3, 
i. e. 



X = 54 



A 



Ay.- 

" — | £ 






Substituting equation 5.8 where applicable. 
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■z> 



' (5.9) 



X = 



» <*- <3v\ 

G _= L 
- - ~ U 



x 



or x = F x where F 




Ca 



oji ( 



The solution to equation 5. 9 is 

- e “ t X (.o ) 



(5. 10) 



which converges for any F with regative real eigenvalues. 

For the time-invariant linear case where H is a constant 
matrix, a unigue G matrix exists for any desired set of 
negative eigenvalues of F; however, for the general case, 
since _=r L obviously varies with state and time, G must 

£)ii K ~ 

generally be a time- varying or state-varying function. Thus 
the problem remains, how to calculate G. Many methods have 
been demonstrated for the case of the time-varying linear 
observer which could be extended to cover this linearized 
case; the method of choice here, however, will be the 2KF, 
which requires some preliminary discussion prior to its 
employment. 



B. EXTENDED KALMAN FILTER — BACKGROUND 

Both [Ref. 3] and [Ref. 8] discuss the analysis origi- 
nally employed by Kalman and Bucy to develop the linear case 
ana the so-called Extended Kalman (nonlinear case) filter. 
It suffices here tc state that the theory applies to 
stochastic systems, rather than the perfectly deterministic 
system considered thus far, and involves perturbation about 
a linearized estimate of the target track in the same 
fashion as Section A above. 
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Figure 5.2 Plant and Observer for the Stochastic System 



Figure 5.2 illustrates the addition of measurement and 
plant (or "system") noise to the problem. The describing 
equations of the plant are now 



x = Ax + Bw 

A- — t 



(5. 11) 



y = H (x) + v 



(5. 12) 
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vhere w is system noise, and v is measurement noise. It is 
important to note that the form of the observer has not 
changed since the discussion in Section A of this chapter; 
now, however, the filter analysis provides a method for 
calculating the sequence of gain matrices G_. 

That last statement concerning a sequence of G's 
suggests the convenience of a discrete (as ’ opposed to 
continuous) representation of the system. Considering that 
the iterative calculations required to compute the succes- 

. A 

sive estimates x will require a measurably finite time- 
increment, it makes sense to work with the discrete system 
equivalent to the continuous system discussed thus far, i.e. 



x(k + 1) = <£x(k) + £ w (k) . 
y (k) = H (x(k)) + v (k) 



( 5 . 13 ) 
( 5 . 14 ) 
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That is, both the system and observer noises are presumed to 
be white independently normal!}' distributed with mean zero 
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and specified variances, which are independent of the 
Gaussian random variable x(0). The observer equation 5.6 
will take the form 



It is now useful to introduce the double-subscripted nota- 
tion required to compute the G (k) matrices in the EKF algo- 
rithra, i.e. 



which signifies an estimate at time increment k based on 
information available at time increment k-1, as opposed to 



which represents the estimate at time k given the informa- 
tion available at time k. 

The final element required to understand the EKF algo- 
rithm is the concept of the error covariance matrix F(k) , 
which can also be thought of as the expected value of the 
error vector squared, i.e. 



Its derivation and significance is fully explained in 
[Ref. 8], while [Ref. 3] discusses at length its initializa- 
tion. Suffice it here to state that it is an intrinsic part 
of the EKF algorithm, which can now be summarized. 

Given the state estimate and covariance matrix at time 
k-1 and the measurement at time k, the state and covariance 
at time k are estimated as follcws: 




(5. 15) 



x(kjk-l) ; 



A 



x(k |k) 



P(k) = E((x) x ). 




(5. 16) 
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P (k | k-1) = 5 1- [gP' ; 

G. -- 



where 



^ O o 

O <V c 

o o <r H 

The EKF gain matrix is then calculated as follows: 



g (k) = P(k\r-\ N ) U t M W(>\ P CvAw-^ •* R 



) 



wnere h (k) = 



ea 

IxtU^ 



A>ni^> R = 



T- L C O 
O C 

C O T/ 



(5. 17) 



(5. 13) 



Finally, the state vector and the covariance matrix are 
updated as follows: 



x {k lk) 
P(k|k) 







b ^ ~ p (>\v--p 



1- £(V)wck\| ? 



(5. 19) 
(5. 20) 



All that remains is the question of initialization; [Ref. 3] 
develops fully the method used to initialize both the state 
vector and the covariance matrix, specifically the use of 
the first two target observations to generate initial esti- 

S' 

mates for both x and F. This method is illustrated in the 

— ,A- 

specific example that follows inmediately. 



C. TARGET TRACKING WITH THE EKI 

This section discusses the development of a computer 
program designed to implement the basic Kalman-Bucy filter 
algorithm discussed in Section 3 above. While admittedly 
crude, it serves as a first-cut tracking algorithm and can 
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be used in conjunction with the observability analysis of 
Chapter IV. The problem divides itself naturally into two 
parts, namely developing models for the satellite and the 
target; and then using the EKF algorithm, that is, equations 
5.16 through 5.20, to see if the satellite can track the 
target. 

1 . Sat ell ite and Target Mo dels 

This is the time when the various equations devel- 
oped in Chapter II (satellite) and Chapter III (target) are 
necessary. For the purposes of this problem, a satellite 
with an altitude of 600 nm and an orbital inclination of 

O 

63.4 is used, as this is a typical orbital pattern used to 
ensure whole-earth coverage in a multi-satellite constella- 
tion. A surface target simplifies the problem slightly, as 
x need only be four-dimensional; thus the target chosen is a 
surface vessel on a heading cf 315° at a speed of 28.3 
knots, which equates to a northerly velocity of 20 knots and 
an easterly velocity of -20 knots. At time zero (i.e. k=0) , 

C ^ 

the satellite is located overhead the point (0 N,0 E) , while 
the target is located at (45° N^O^E), which is initially 
below the satellite’s horizon; the program is designed to 
compute (R , oL , ft ) as (0,0,0) until the target comes in 
view. The computer program listing appears in Appendix B; 
of perhaps greater interest is the data which appears in 
Table V, which shows the program run for 23 minutes with a 
time step of 30 seconds, i.e. k running from 0 to 56. For 
this single pass, the target vas in view for 117 steps in 
time, or 19.5 minutes, a fairly representative viewing time. 

2 - EKF Operation 

In the main, the EKF algorithm used in the computer 
program that appears as Appendix B is the direct application 
of the equations 5.16 through 5.20 to the particular 
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TABLE 7 



Target and Satellite Simulation with Observations 



STEP 


TIME LAT 


LONG 


LAT 


LONG 


RANGE 


ALPHA 
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problem, complete with the intermediate calculations 
required to evaluate some fairly involved matrix multiplica- 
tions and inversions. However, two aspects of the program 
require further elaboration. First, the filter initializa- 
tion, to which Section B of this chapter alluded; and 
second, the computation of the Jacobian observer matrix h, 
which in this case is anything tut trivial. 

a. Filter Initialization 



The method developed in [ Bef . 3] has been 

followed exactly here, thus a two-point initialization is 
used. Specif ically , the northerly and easterly positions 
calculated from the observations (R, oL, ) at time steps 0 
and 1 (i.e. the first two nonzero observations) are the 

initial estimates for x y and x 3 , and from them the initial 
velocities are computed, i.e. 

X ^ , 

\ M = up ( K. Cc) / [o) i $ c c)) ( 

y, b) - tA; 

$iO\ -- up (jtC'), ^ , 



and 



V, (v\ - C c ) 

— ) 

\ 

T 



( 5 . 21 ) 



From these calculations, it can readily be shown that an 
initial estimate of the covariance might be 
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(5.22) 



The details of this calculation, which involve taking the 
expected value of the error vector squared as discussed in 
Section E above, appear in [ Eef . 3]. While it could be 
argued that other methods of iritial covariance estimation 
are available, this method should suffice for the purposes 
of this analysis. 

This completes the initialization of the filter, 
and from time step ”2" (third nonzero observation) onward, 
the filter runs according to the algorithm of equations 5.16 
through 5.20 . 



b. Observer Function Matrix 



The observer function h is defined for all times 
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Computation of the matrix elements in the computer program 
(Appendix B) is performed in accordance with the following 
derivation. Consider first the following set of equations 
from Chapters II and III that summarizes the computation of 
(R, A) from x (surface target case): 
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Figure 5.3 Functional Eelat ionships Between 
The State and Observation Vectors 

Obviously, some fairly involved chain-rule differentiation 
will te required to compute the partial derivatives in tne h 
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matrix of equation 5.23 . Figure 5.3 summarizes the func- 
tional relationships hetween (H , oL , ft ) and x. By the chain 
rule then 
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(5.27) 



All that remains is tc perform the required partial differ- 
entiations on equations 5.24 for substitution as appropriate 
in equations 5.25 through 5.27 so that 
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It is left to the computer to calculate numeri- 
cally the partial derivatives described by equations 5.28, 
and then substitute those values into equations 5.25 through 
5.27 to evaluate the h matrix terms. Sequentially, these 
computations take place after the state and covariance esti- 
mates are calculated, and before the filter gains are 

/V 

computed for each iteration k, using x(k|k-1) in all cases. 
This completes the observer function derivations. 
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D. 



DISCUSSION OF EKF TRACKING RESULTS 




Figure 5.4 True and Estimated Target Track 
From Range, Alpha, and Beta 
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Using the DISSPLA graphics subroutines at the program's 
end, several sets of curves were generated. Of general 
interest is the tracker's accuracy when R,^, and $ are all 
available, as opposed to E and pi only, or pC and only 
(passive tracking, potentially). The series of graphs that 
comprise Figures 5.4 through 5.6 show the filter's perform- 
ance for a single pass of the satellite. 

From these three graphs, it appears that the filter 
estimate does converge to the true target trag'ectory in all 
three cases, and that the filter estimate is more accurate 
when all three variables are present than when only two are 
available. A single run of a random process has a minimal 
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Figure 5.5 True and Estimated Target Track 
Froa Range and Alpha Only 



amount of statistical signif icance, however; thus repeated 
trials of the filter's tracking will be required. In 
[Ref. 3], Bar-Shalom discusses in several instances the need 
for multiple sequential testing of any filter based on 
stochastic principles; the statistical average of these 
"Monte Carlo runs" then begins to have some signif icance , 
increasing in value in direct correlation to the number of 
runs considered. 

First/ however, a criterion must be established for 
error comparison. Bar-Shalom 's suggestion is the use of a 
state-squared error function, defined for eack k as 

SSE(k) = ^Ly) p yj . 

✓ — ' 

Application of this criterion to this filter (not shown 
here) indicates that while the filter is able to track the 
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Figure 5.6 True and Estimated Target Track 
From Alpha and Beta Only 
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target in all cases, there is room for improvement in its 
performance. Specifically, the quality of the filter opera- 
tion can be gauged by how statistically well the SSE values 
fit within a confidence interval, where 

N = (number of runs) X (error vector dimension) . 

In this case, when a 95 % confidence interval (i.e. the 
region within which 9 5 5b of the SSE values should fall based 
on the probability distribution) is considered, less 

than half of the SSE values fall within it for any of the 
three cases under consideration. Speculation as to how the 

filter’s performance can be improved is reserved for Chapter 
VI; in the meantime, however, a simplified criterion can be 
employed here to attempt a rough evaluation of the relative 
effectiveness of the three different modes of filter 
operation. 
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Figure 5.7 Simplified Error Criterion vs Time 
For a Single Trial of the Filter 
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A simplified error criterioc that suggests itself might 
SSSE(k) = rvwOj 



where the time step functions as a scaling factor to roughly 
equate the significance of the position and velocity errors. 
Figure 5.7 shows the application of this criterion to the 
single run. 

Once again, the results seem to validate the hypothesis 
that the filter works better for all three variables than 
for two, but this is still information gained from only a 
single trial. Now that the error criterion has been estab- 
lished, however, the Monte Carlo runs can be considered. 

The number of runs is chosen to be 20, and the first 
application of the repeated trials was to smooth out the 
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Figure 5.8 True and Estimated Target Track 
From Eange, Alpha, and Beta 
For Twenty Monte Carlo Runs 



estimated trajectories in Figures 5.4 through 5.6; the 
result was the series of Figures 5.8 through 5.10 . The 

initial perceptions of the filter's ability to track the 
target appear to have been borne out, that is, the estimate 
does converge to the true track in the general case, and the 
filter tracks better when all three variables of observation 
are available. However, the initial error in the estimated 
track proved not to be an anomaly of the particular trial, 
but showed up repeatedly throughout the Monte Carlo runs. 
This suggests an imbedded error in the initialization 
process for the filter, possibly in the initial covariance 
estimate; this would also help to explain the filter's 
failure to place the SSE values in the Y-&. c °nf i dence 
interval. Examination of Figure 5.11, which shows the 
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Figure 5.9 True and Estimated Target Track 
From Range and Alpha Only 
For Twenty Monte Carlo Runs 



simplified error criterion for the 20 runs, also tends to 
validate the results of the single trial, and further 
supports the supposition that the filter correctly tracks 
the target in each case, although there is some initial 
error. Finally, Figures 5.12 and 5.13 were drawn to take 
another closer look at the quality of the filter estimates 
ever 20 runs. It now becomes obvious that a primary source 
of error is in the initial velocity estimates. Also, the 
filter's slow (30 time steps or 7.5 minutes) convergence to 
the true velocities indicates that some error in the initial 
covariance estimate is indeed present. Ironically, because 
one initial velocity estimate is low and the other is high, 
the filter's initial estimate of the target's speed is 
fairly accurate; it is the estimate of target course that is 
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Figure 5. 10 True and Estimated Target Track 
From Alpha and Beta Only 
For Twenty Monte Carlo Runs 



initially in significant error- This could well be a func- 
tion of the geometry of the nctlineari ties of the problem, 
indicating a potential pitfall of assuming that white noise 
will remain white after undergoing several nonlinear trans- 
formations. Tracking targets moving in other directions 
might well shed light on the veracity of this supposition. 

To summarize briefly, although the filter’s initializa- 
tion might be improved, it nonetheless demonstrates an 
ability to track the target in all three modes of operation. 
It provides evidence that the target track is more accurate 
when all three variables of observation are available as 
opposed to only two, but that operating in the X - /6 mode 
does not really represent a sigrificant degradation over the 
H- X mode. This is an important result because it allows for 
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Figure 5.11 Sinplified Error Criterion vs Tine 
For Twenty flonte Carlo Runs 



the possibility of passive target tracking. The supposedly 
unobservable R- /£ mode of operation is not attempted because 
the solution of the equations that comprise the filter algo- 
rithm without R or is difficult but feasible, but without 
using oC it becomes impossible. Verification of the unob- 
servability of the target tracked by range and altitude 
angle only thus requires a different filter. 

This completes the discussion of the results of the EKF 
tracking a surface target, and concludes the analytical 
portion of this thesis. 
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71. CONCLUSIONS AND RECOMMENDATIONS FOB F URT HEE WORK 



During the evolution of this thesis, it has become very 
clear why the observability of nonlinear systems has histor- 
ically been an unsolved problem, at least in the most 
general case, and inroads have been made only gradually by a 
relatively few individuals. The algebra involved in 
applying any mathematical form of analysis to a nonlinear 
system is freguently so prohibitive as to make such proce- 
dures of questionable value. Consequently, the observ- 
ability analysis of a nonlinear system is frequently based 
as much on intuition as demonstrable mathematical proof. 
Thus while the statement of this problem — observability 
analysis for a satellite tracking an earth-bound target--is 
reasonably simple, it quickly becomes obvious its formula- 
tion is not. Specifically, every reference available 
pertaining to either the satellite-target dynamics or nonli- 
near observability uses a different notation, and there are 
very clearly defined crossover points in the information 
available. Most sources either discuss the satellite’s 
orbit in the language of physics, describe target observa- 
tions in a purely empirical sense, or discuss nonlinear 
observability as applied to a general state space. 

Consequently, one of the major objectives of this thesis 
becomes the synthesis of as much available information as 
possible on the entire problem, and the formulation of a 
pertinent and coherent state vector model. For the sake of 
their universal recognition, latitude and longitude are 
retained as the earth’s surface coordinates, although much 
debate has taken place on the subject of alternative coordi- 
nate systems that might pertain. Certainly, one would hope 
that there exists another reference frame wherein the 
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mathematical observability analysis of Chapter 17 could be 
simplified such that the transformation to rectangular coor- 
dinates would not be required. Similarly, the calculations 
required to implement the filter algorithm of Chapter V 
might also be streamlined. Because there is potential for 
continued exploration of these and other aspects of this 
problem, the suggestions for further work made below are no 
less important than the specific conclusions that can be 
drawn from this research effort. 

1. C0NC10 SIONS 

As is so frequently the case, the original intent of 
this research was overly ambitious in attempting to solve 
both the complex nonlinear observability and target tracking 
problems. The results presented here, however, do systemat- 
ically show the interrelationship of these problems, such as 
through the computation of the Jacobian matrices for the 
perturbation analysis, for the EKF, and for the observ- 
ability analysis. This points cut the need for an efficient 
algorithm for high-order Jacobian evaluations. 

The analysis presented here forms a good base for 
continued research on tracking satellite deployment geometry 
and desired receiver information. The parametric descrip- 
tion cf the satellite dynamics pertinent to this problem 
involves a great deal of information not necessarily 
familiar to most engineers. This research proved inter- 
esting, and is well documented in the literature. There is 
a wealth of diverse information available in sources such as 
[Ref. 5] and [Ref. 6]. The intent here, however, is to 
integrate this information intc a coherent overview of the 
mechanics of an orbiting satellite and its observation of a 
target moving on or near the Earth’s surface, providing 
enough information to fully define the problem without 
drowning it in minutia. 
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Next the physical system is redefined in terms of the 
state vector space more familiar to Electrical Engineers. 
Also, the analysis establishes the computational procedure 
for translation from observed satellite data to earth 
surface coordinates. Appropriate coordinate selection here 
is obviously crucial to the o Iserv ability analysis. Any 
method of locating position cr describing motion on a 
sphere, however, requires a radial vector and two angles, 
which is precisely what is defined by latitude, longitude, 
and altitude (i.e. the radial vector from the Earth's 
center) . The further conversion from latitude and longitude 
to northerly and easterly distance is made in an effort to 
at least partially linearize the problem; the merit of this 
decision is proven by simulation, wherein the constant 
velocity target is modeled very simply in these coordinates. 
Had latiude and longitude been retained in the plant coordi- 
nates, even this simple case would have required a highly 
nonlinear description. 

W it h regards to target observability, the simpler cases 
considered first are intended to provide some intuition 
about the problem. From the linearized case, it is deter- 
mined that having the position variables available for two 
or more observations is equivalent to observing both posi- 
tion and velocity during a single look. From the case of 
the nonlinear model of the stationary target, it becomes 
obvious that the coordinates derived in the earlier chapters 
are not especially well-suited to this method of observ- 
ability analysis. Thus another transformation is performed, 
this time from the spherical space into a rectangular one. 
In the process, it is discovered that a stationary target's 
position can be fixed with two or more looks at a single 
variable of observation, which might prove of great utility 
if it is desired to locate passively a land-based radar 
transmitter or communications station. When the moving. 
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airborne, general-case target is ultimately considered, it 
is shown that such targets prove unobservable when only a 
single parameter of observation is available. When the 
variables of observation are considered in combination, 
however, the target becomes otservable in virtually every 
case that includes at least one position variable. The 
insight developed during the mathematical derivation of the 
coordinates suggests that the B .- combinations should prove 
the exception to this rule, and lead to an unobservable 
system whether considering complete state or just position 
observability. Demonstrating unobservability conclusively 
by this method, however, would require the evaluation of 
some 130,000 determinants; thus applying the analytical 
method to demonstrate this result is of questionable practi- 
cality. While a complete nonlinear observability analysis 
then is almost impossible, the analytical method does 
provide further insight into relevant aspects of observ- 
ability for the problem. One particularly important result 
of the analysis is the c^-only tracking of the maneuvering 
surface target, and the o(r/$ tracking of the general 
target, both very useful if a passive sensor is of tactical 
advantage. As a footnote, the greater sensitivity of the 
observer matrices to fluctuations in /5 than to R or <x. is 
discussed briefly; further development of this topic is 
certainly possible, although time did not permit it here. 

The first-cut attempt at a tracking filter design serves 
to validate many of the concepts and intuitions brought to 
light during the observability analysis, including the 
feasibility of oL~/$ tracking, and the greater accuracy 
possible when employing all the variables of observation. 
The inherent problems of the EKF in general and this version 
in particular lead one to conclude that this is not the 
optimum method for tracking a target. Fortunately, other 
methods are available, including the Truncated Second Order 
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Filter (TSOF) and the Gaussian Second Order Filter (GSOF), 
Loth discussed in [Bef. 9]. Their greater utility should 
not, however, take away from the fact that this EKF does 
generate an estimate that converges to the target's actual 
track in all three phases of its operation, at least for the 
small number of cases considered here. It also proves that 
the coordinates developed in Chapters II and III to describe 
the problem, while not particularly well-suited to the 
observability analysis of Chapter IV, work demonstrably well 
in engineering application. 

B. RECOHME3DATIOHS FOB FOBTBEB SORK 

During the development of this thesis, it became obvious 
that to discuss completely ail aspects of this problem at 
this time would not be possible; thus these recommendations 
for further work are made. A final word on the subject of 
coordinate selection: for evexy equation that appears in 

Appendix A as part of the Jacobian observer matrix calcula- 
tions, at least half again as many equations were derived 
during abortive attempts to apply this method of nonlinear 
observability to the problem in other coordinate systems, 
including latitude-1 ongitude-altitude, fi-n. , and R - X-/5 as 
the plant (i.e. system) coordinates. None of these provide 
any simpler mathematical results; in fact, they all prove 
even more complicated to employ. Perhaps by redefining the 
problem in terms of a new set cf coordinates not discussed 
in this thesis the observability analysis could become more 
streamlined and/or definitively conclusive, but no such 
coordinate system has revealed itself thus far. 

Next the question of the tracking filter should be 
addressed. Had more time been available, this report would 
have attempted to improve the filter performance, either by 
eradicating the inherent errors apparent in the state vector 
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and covariance matrix initializations, or else using a more 
sophisticated filter such as the TSOF or GSOF. Further, a 
two-stage nonlinear filter has recently been proposed which 
shows superior trading perfornance to any of these; its 
specifications and performance are discussed in [Eef. 10] 
and [Ref. 12]. The employment of these or other more 
complicated filters might well afford the opportunity to 
verify the feasibility of an c4-only track of the maneu- 
vering surface target or the purported unobservability of 
the track. The goal in this thesis, however, is not 

actually to design the optimum tracking filter, but to 
demonstrate the possibility of doing so. The El F is a rela- 
tively simple algorithm, and thus is useful here; even so, 
there is room for further analysis of its performance. 
Other methods of initialization might be considered, partic- 
ularly for the covariance martix; also, the tracking of 
other targets, such as a maneuvering surface target or an 
air target with its six-dimensicnal state vector, might be 
attempted. An analysis of its sensitivity could be 
conducted, varying both the system and the observer noises 
in turn; this would hopefully validate the declaration in 
Chapter IV that the system should be more sensitive to fluc- 
tuations in /$ than those in R or . All of these varia- 
tions on the theme of filter operation could of course aiso 
be undertaken for the alternative filters. 

No mention has been made thus far of multiple targets or 
multiple observers, hut of course the situation explored in 
this thesis is the simplest possible, that is, a single 
target being observed by a single satellite with a perfect 
probability of observation when in view. In actuality, of 
course, the problem is far more complicated, as the consid- 
eration of multiple targets and multiple observers immedi- 
ately introduces the probability of false target detection; 
of improper correlation of targets to successive or 
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simultaneous observations; and of missing detection alto- 
gether. By viewing the entire process start- to-finish as 
stochastic rather than deterministic, the problem ultimately 
achieves a true real-world significance. In [Ref- 3], 
Bar-Shaiom has pulled together a wide variety of resources 
to analyze just this sort of situation in the general sense; 
the application of the principles discussed there for this 
particular problem would arguably generate several more 
reports as involved as this one. 

On a higher level, the theoretical implications of the 
applicability (or limitations thereof) of the method of 
[Ref. 1] to this problem and others of equal difficulty 
might be discussed. Previous employment of this method has 
shown the utility of such observability testing in deter- 
mining the lack of observability of the bearing-only target 
(EOT) for typical earth-borne radar and sonar applications. 
The complicated geometry of this problem has not yet yielded 
such complete conclusions; the potential exists, however. 
Another topic that might be explored further is the perva- 
sive nature of the Jacobian matrix, which appears as part of 
the observability analysis; in the development of the nonli- 
near observer here and elsewhere, i.e. [Ref. 10], 
[Ref. 11 ], and [Ref. 12]; and again in the computation of 
the observer functions for the filter. Finally, the contin- 
uing effort must be made to resolve all these results, 
current and future, with the empirical evidence available of 
track observability and maintainability, taking into account 
both the capabilities of the sensor and the wiles of the 
target. 
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APPENDIX A 

DERIVATION OF OBSERVATION MATRICES 

The following series of derivations follows the pattern 
established in Chapter 4 Section B for establishing the 
terms in the Jacobian observer matrices for the general case 
target. The accelerations are assumed to be piecewise 
constant (i.e. constant for each time step of a discrete 
observer); thus third and higher order derivatives of the 
position variables will be zero. The derivations are 
grouped by two's into R and R, and , and /$ and for 
the reason that many of the terms in their matrices are the 
same. 

A. OBSERVER MATRICES FOR RANGE AND RANGE RATE 

Consider first that in the rectangular coordinate 
system, 
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Dif f erentiating this equation implicitly six times with 
respect to time. 
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Taking the partial derivative of each of the above eguations 
with respect to n. 
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Solving for the highest order derivative in each equation. 
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Taking the partial derivatives cf the first set of equations 
with respect to n. 
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Obviously, partial differentiation with respect to e and 
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first 



and n; combining those results will lead to the 

observer matrix J for the R observation; 
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o 


V 


* » 




0 




a - 

i 


(L 

v\ 




** 






H 


Ui 


"V 




V‘\ 


.»v 








K 


R-e 
























ij 

1 




ir e 


Ve 


rI 




Note that the last 


equation 


of 


each 


derivatives 


was 


not 


required 


at this 


necessary in the 


case of 


R. 


The lo 



are linear combinations of the rows above them; to simplify 
the matrix for the purpose of evaluating its determinant and 
testing it for positive or negative definiteness, it must be 
row-reduced by subtracting each of the higher rows (multi- 
plied by the proper constant) from the lower rows as 
follows : 












icoo b - — Rov.ol - flexor - 



vc«l 

\0 



[bc > i 3 — 



— ^ 7 ' 3 " 



(tewi 5 — 

(ZjToo 4 — 

{Zjl, \*j s — 
vLcto ). — 



^ (Lc^-^r 



At 

V- 



fa-wt - (tewi 

V 2 - 



— (tew i. - (oCobr. - tc> 

V«- 















lot 

IT®- 1 ' 



At 

t 



|Ujw4 ' 
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The resulting matrix is 



T = 





— 

Y\ C 


€L 


O 


w 


*1 






r\ <\ 


e 


e 




u 




J3 


Q n 2a 


o* 


le 


a* 


ZW 




fO 


2 

C3 

O 


o 


a fc 


G 


OL *j 


• 


1 


O 0 


G 


G 


G 


G 




1 

[ 


0 O 


O 


G 


o 


O 




terms for 


the 


c 

H 


matrix J., 
>■ ^ 


have already been 


they come from 


the 


same sets of equations just 



derived, only the 
on , I • e . 

r~ 

fi-.N 
\\ 
ft 

A 

G - ft 

^ L <A 

w 

ft. 

ft" 



first is left off and the last is added 



«; t, Oj, o^v 

k K k ft, *«• 



«. ft.. R. 



‘ e 






(0 (T R' y ft'" ft 1 

e ^ u 



r- Rt Rj <c r'c 



vW 



\A 



<G <C ^ K ft" 



k 



2y the same method cf row reduction just employed, this 
matrix will reduce to 



1 1 1 



Nil 


.. 

(\ 


A 




g 


V\ 


4 


Z>R 


a. 




Gc 


Ze 


Cvh 


zw 




o 


Of! 


G 


a c - 


G 


G* 




G 


o 


G 


o 


G 


G 




O 


G 


G 


o 


G 


G 




V\ 


G 


G 


G 


W 


G 



B. OBSERVER MATRICES FOE AZIMDTSAL BEARING AND AZIMUTHAL 
BEARING RATE 

The derivation of the Jacohian observer matrices for the 
azimuthal bearing variables o(. and c<. follows the method of 
the previous section, except that the result is not quite so 
algebraically nice. Consider first the definition of in 
this coordinate system: 

oL - tam" e /, x _ 

Differentiating once with respect to time, 

3 - en 

t Z_ 1 

n >c 

or V\t£-ew’ ; yxS e \ 

Differentiating five more times with respect to time, 

4 X 4 " v\a £ - e a* 

ml 'TjH + iLl - vCa^-ecu 

XZ * 3^1 4 / - o, 

TY t 4 Gil * o, 

XV v 5 X x 7 4 \o£ / t vciVi - o; 



1 1 2 



vher e 



} 



~ 1 <\r\ v le c. t 

\ w 

X. ~ 0>w(\ ** * ke c-<f, 



X"* " 

S'* - O. 



Solving for the highest order derivative in each equation, 
one obtains 



o 

«*L " 


X 


Xe -e»\^ 


tv 

/ = 


75 { 


~eu* -x/.y 


lO 

i “ 


X 


/ O C W \ J v \\ 

(acij -ea.-Xx - XX /-J ( 


^' N 


X ( 


v -ii- s£y - 5 iZ), 


<** - 


i( 


l ”'S '7 - 4 £ 2 - (,i.x - 4 X 4 " , \ 


'v' 

ot - 


i( 


- >v ' " .V, " n\ 

'bX/ - »cse/ - vox/- - 5 X* J 



Taking the partial derivative of each of the first seven 
equations with respect to n. 






w 



-e 



i 



X/- 









c 



i.i r 
•ini > 



o » 
" v 



^ ^ v 4 ^ ' ^c ( 

* xii . rjJ ; . . *„•<. al. 



-o 

i 
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% l K v JL W ^ 3£. v / v 3^J. W V * XA* - O 



x: m/,. 



»V\ u "V '> U \\\ \v w\ ° 

4-X^il v 4^.A U v 4X*i. *■ ■* 4X 

* XX'** x 4 = o ( 



i' v 

Lflt * 



VM 



5 X* ^ T 5% / K * \o ^<4 + \<ss. + \oX°C t 5 X v ol «■ bl d. A 

i ^ # VV — \ 4 l 

* + Xx - o * 



where <\W ( X K * “L*. 

1L = -L,\a aec , - Zrv t 

i -- ><vaw**, Zez s . 7 ;' t„- 3 & „ 

\W 

" V 

' 6 ^ u t Gea- ^ = 0 

» K 1 

^ *■ ^c 7 , - O , 

3> G, 

Solving for the highest order derivatives. 



< ’ e /x i 

*•“ 1 ^(e -%„!'), 
° \ 



i«’ 



(/ 






S \ 

w 



(-xJ- ^iL- 

' 1 

( . * iu _ - V' V' " '> ' \ 

-!„/ 3 X.^-Si/ U - S&.J.-'X.O, 

/ rr , ^ i JL \\i , , °, \\i 'v |V * vV \v* , J 

'S ( - /■ ^t,x - Gh*i„- - 41 XV 

p„/ - 5 ^A a - 5 X a A -\< 3 X 4 A -\CXX. - 



X 



T 
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Taking the partial derivative of each of the first seven 
equations with respect to n follows the same pattern; 
solving again for the highest order derivative. 



<^h 


- o ; 


\ 

Ji v 


- - e / 


\' 


i(' 


v ". 

^ lA 


-iO 


. >x 
V 


i / 


lA- 

a 


% ( 


\ 


-i(- 


w 


- i(- 






where £ = a% e\ %'„ "O 
X - 2 _a v\ + Zee-^ 

~ 'Zaq m +'7v\ z ‘+- , '^c^ X- '4a 

• * > 

\w 

t v\ o ^ ^ - Go M 

X = 4>G M Z < 0>C<^ xX r O 
X' = o. 

The differentiations with respect to e and e follow the 
identical pattern, with the exception that the (n,n,a„, ) 
terms are replaced by (e,e,a-) terms of opposite sign, so 



° 4 : 
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c4 

oV 






\\ <• \ 



of, = i 



- 

o( e " 
- 



X 

4( -a~-X,i -I< e -lJ) , 

1 / U\ ' V' \ \\ " x N - \ 

^ —~%e J~ ~ ^%U ~2.’£e'^ 

^ / \J * ‘VJ . \VJ w u\ 'N v*> in <*P * \ 

^ ^ *“ ^A > £e/' ~ £>lL ^ ~" ^e) 

-Xe c4 - 5£ A - 5S* /- - VC& JL e - VO^e /- - \C& / c - 5&X) 



o 



<Z - V*. 



o 4 , 






. I 



o( 



iN 



cL 

l/ 



e 

'ji 



wher e 



\ / ° ‘ r °\ 

X \"XX - X A 

5 (-^.' - X - =Ji. i«> - 3,t e J - % ) e . -I,. )\ 

* (- *10 - *1 / - &£ / e - gx, ; - 4i; 4 - ^ i - X , 

X (- - 52^ -ici: / e - lcl, e / -\c£^/-s£i e ) 

X » »‘, e ‘ ^ -o, 

\ 

w v o 

X. " X\v\ +7ecT ( X c * Zcf. : "2 jC , 

v\ 

X “ k,vc ;j •* GcrC ^ # 1 6 --o ( X e *- <£a* ( 

^ - 6 a-‘ * ^ s i = 0) x; = 0| 

1 = O . 



r 4 *e 



1 1 6 



Obviously, all the partial derivatives with respect to h 
will be zero. 

This leads to the formation of the Jj and J* matrices 



°^k C^ N <A C 0 O 




— • j • c 7 

CxG l>G i/- e jG (j G 


^ ^ o^ c O O 




" 4- " 

c*C ji< (4 c o 

K X v 


U U 

O O 


■ 3* - 


1“ 

0^* o4. ^ G O 


C O 


> ^ 


W W IV 

^ ^-A ^ c O 

V V V ^ 

y / t 


\V w W 

oC ^ o 




[ ot* jLk oLe Jjs o G j 




DCk O^k e ^ O 

>4\ VI vi 




O 0 1 



which are simplified by the same sort of row-reducing method 
employed in the J, and J matrices. This time, however, all 
the terms do not cancel simply, and the result is 





- e_ 


o 


V\ 


O 


O 


o 




U'h 


-e 


— ^ V Ve. 


v\ 


o 


o 


l 


ck'jL 


'f-. 


+■ 

2 

i 


K 


o 


G 


2? 


K 




I' 

K-e 


~£G- t 


o 


G 




K 


3k 


h 


i* 

5 >e 


o 


O 




G 


3k 


K 


iU 

A-?s> 


o 


G 
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■e.r 


-c 




n 


o 


G 






* ]Lv 


K 




Te 


o 


G 


A 


1 


*\ 


Qt 


y-e 




G 


G 






U\ 

%v 




u\ 

y~t 


V' 


O 


G 






G, 




VV( 




G 


6 






xi 


5X1 






G 


G 


%, 






O 

i, 










r 


\ 
















v e ~ 

i 


~ S* t e / 




: I -5L, 










*« “ 


w. * d 






\t 

A 






y. 




-l..e CC 


Si ° 

- 4X V , 


X -GX, 


,ei\ 






V: 


= 


-l,e ■*- 




/ -\C&. 


r 







C. OBSERVER MATRICES FOR ALTITUDE BEARING AND ALTITUDE 
BEARING RATE 

The derivation of the J and J matrices for tha alti- 
tude bearing variables /$ and ^ is the lengthiest of all, 
but using the lessons learned in the previous two sections, 
it should prove no more difficult. In this coordinate 
system, 

/S' cor' 
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Differentiating once with respect to time, 
e V\C'Av\->-e<s) — V\ ( 

^ (/c^ e x v Vx'O C o't -e 1 V 1 '*- ) 

or Q./> - V\(y>vw ce ) — U ( G = (ti 1 ve^ ^ 

The next five time derivatives are taken as before, and then 
the partial derivatives with respect to n, n, e, e, h, and 
h. Eliminating all the intermediate steps which would 
follow in exactly the same sequence as in the previous 
section, the resultant observer matrices are 



J ~ s *&' 



( 

(Si 



- 

v\V\ 0 


eU 


o 


— v\ l - e *" 


0 

\ 


v\U-7.v\V\ wl\ 


eU-teh 


eU 


An 4«e tV„ 


-*}-c j 




+< W 






\ . 1 


«< t\- 1\ ZaV\-y\V\ 


C^U-e U 


ZeU-c^ Aa^ca. 

v A 




-ZaChW - .. v Hv 




+«v«. 


n *■ e ♦ 


4 +u 

k > 


-3 v V* 3v\a„-3.\a rt 

*c\ ^ 


-3ca^ V e 


-Zecu+YhC; 


r 3ec£ 

\l 








♦K 






-3ac a„vf e 


3Ua & -lec* 


3a>3c* 1 
+ H 


3*\C*v*deui 




\\j 










u\ 

-4cct./4v c 




ttv.fv tc« z 


L 








^Ay U 

j 


l-AU-tyx^ V\V\ 


eU-leW 


eU 


v\a vet 


-V-<* I 












dk«jVv-V\Vx 


C'eU-c.V 


t-iU -e.u 


AGu ’ e’ ti < 


-An -<e rH- u \ 


"ii'ftK • V* v Mr* 


'Zea^ 




*A*ve% 4u 


j 


*» 

-36 H V\ t 'I', tUCj'dAd!* 




~3cx. H *3ka 6 


3>V\C.« ’•dec.. 








•<7iV 4 






3g«,Uh d>vio^-3.\o.. 


•-3Q M aH^e 


3Uc>, -3<zC*i 


3a ^c,/ 1 


; 3i\u,» *3 cg<? 


**h. 




-3^ 


•* td 


*3*u 


t - 


»V4 


v\j 

v S' w 


6^'s' *-b£U- ' 










* 


^ ■iH-; 


% 




M*V 
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where 





- & , / 






M 

4V<.W ' 


in 

~ $u, <?, U /> - v /? - 6j^e t U />, 


^.<,k 1 


-(S^e.w/S’- 3 <&*.<>/$- } - 


v* 

T *.<,W “ 


''ft " ^ G<& r < w ^ - 


^.«.w = 


*K.<,lyp S - \G<L.«.U 



kt « o 

U fi, 

U 6 " ^(Si^ e v y$ 
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APPENDIX B 



PROGRAM LISTING FOR THE SATELLITE-TARGET SIMULATION AND THE 

EKF IMPLEMENTATION 



C 



DECLARE 
IN TEG 
REAL 
REAL 
REAL 
REAL 
REAL 
REAL 
REAL 
REAL 
REAL 
REAL 
REAL 
REAL 
REAL 
REAL 
REAL 
REAL 

RiAij 

REAL 

SEAL 

REAL 

DOUBL 



ALL VARIABLES 
ER I , J , K, FLAG 1 , FL 
DT,PI, AO,DPHI,OME 
SO ,RHOMAX,RHO, RS . 
LATS { 1 21) , LONG S (1 
RANGE (121) , ALPHA ( 
XI (121) ,X2(121) ,X 
XHAT 1 ( ll 1) , XHATz ( 
PI ( 1 2 T ) ,?3 (12 1),? 
XN HAT 1 .XNHAT2, XKH 
PN9, PNA,PNB, PNC. P 
PNF.RHOHAT.ALKAT, 
DR HDNU , ENU DX 1 , DR A 
DA LDRH , DALDNU , DAL 
HI ,H2,H3,H4,A,B,C 
Q4<Q5.Q6,F.5,R6.R7 
~ ill) ,YG1 (ill) 



AG2, COUNT 1 , 
GA,PHI,DENO 
NU, L ATHAT , W 
21) , TIME (12 
121) , BETA (1 
3 .(121) ,X4 jl 
ill) .XHAT3 ( 
4(121) ,?9 (T 
AT3 , XNHAT4 , 
ND.PNE, G8.S 

bhIt,behat, 

DRH, DRHDX 1, 
EX1 .DALDX3, 
,DET, R 1, R2. 
-j f l\ ml\ i ,Ro , n9 , RA , R 
EAL XG1 (ill) e YG1 (ill) ,YGl(lll).Y 
EAL XAVE1 (ill) , XA V E2 ( 121) ,XAVE3 ( 
EAL LONHAT . LGNGT { 1 21 ) ,?N3, S5,PFj 
L P3 (121 ) ,PC (121) , INN0V3.S1 . S2 
L HCHAT, eAlPX3,PALDIA,DBEDX1 ,D 

E3 , B 4 , G3, 34, G 



SSEBAR (121) ,E2,E 
E PRECISION DS EE 



COUNT 2 ,L,M,N,INK 
M, D LATS, D LONGS 
N 1 , WN2 , GGN OF , RS2 
1) ,LATT (12 1) .A52 
21) , ASIG.3SIG ,S4 
21) ,?E (ill) ,PN4 
121) , XHAT4 (121) 
21) , P A (121) ,ESIG 
PN1 . INNOVA, SSIG 
7. S8, INNOVR , N SIG 
DLADX1 ,DRHDLA,GC 
DRADX1 , D N U D X 3 ,Q2 
DBEDRA , D EEDRK ,03 
R 3 , R 4 , G 1 , G z, hSZ 
B,RC,H5,H6,D, E, F 
g 1 (ill) ,SSE (121) 
121) ,XAVE4 (121) 
121) , PD (12 1) , ES2 
,S3,G9, GA ,G3, El 
3EDX3, XG2 (121 ) 

5, G6 , G 7 , Q 1 



C CONSTANTS 

FLAG 1 =0 

FLAG 2 =0 

DT=. 25 

PI=3. 1415926 

A 0 = 1 . 1065337 

DPHI=PI/53.' , 249 

OMEGA =PI/720. 

R0 = 3 4 28. 

R S =4 0 38 . 

RHOHAX=ACOS (RO/RS) 

A SIG = PI/1 09000. 

3SIG= PI/108000. 

ESIG= .002 
NSIG= .002 
R SIG = . 1 
AS 2= ASIG* * 2 
BS2 = B SIG**2 
ES2=ESIG**2 
N S2= N £IG**2 
RS 2= E SIG* * 2 

C OUTER OUTER LOOP FOR ALTERNATIVE OBSERVATIONS 

DO 36 I NK= 1 .3 

DSEED= 123486579. 



C 



CUTER LOOP FOR MONTE CASIO RUNS 



DO 92 1 = 1 



,121 

= 0 . 
= 0 . 
= 0 . 



XAVE1 (I 
XAVE2 (I 
XAVE3 ri . . 
XAVE4 (if =0. 
SSEBAR (I) =0. 
CONTINUE 
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DO 94 N=1,20 



INITIALIZE TIME, POSITIONS, MEASUREMENTS 

TIME ( 1) =0. 

LATS 1) =0. 

LONGS (1) =0. 

LATT {1) =45.*PI/180. 

LONGT (1) =30. *PI/180. 

RANGE 1) =0. 

ALPHA (1) =0. 

BETA ( 1) =0. 

X 1 (1) =R0*LATT ( 1) 

X2 ’ 1 )=. 3333333 

X3 (1) =R0* COS (LATT { 1) ) *LONGT (1) 
X4 (1) =-.3333333 

LOOP TO UPDATE TIME- POSITIONS- MEASUREMENTS 

DO 1 0 1=2 , 121 
K= I - 1 

TIME (I) =DT*FLOAT (K) 

SATELLITE POSITION 
PHI = DPHI*TIME (I) 

DEN OM=COS (PHI) **2 + (CCS (A0) *SIN (PHI) ) **2 
DLONGS=DPHI*COS (AO) /DENOH-OMEGA 
DLATS=DPHI*SIN (AO) *CCS (PHI) /DENOM**. 5 
LATS (I) =L ATS (K) + DT* DIATS 
LONGS (I) = LONGS (K) +DT*DLONGS 

TARGET POSITION 

HN1=NSIG*GGNQF (DSEED ) 

WN2=ESIG*GGNQF (DSEED) 



XI (I)=X1 
X2 (I) =X2 
X3 I ) =X3 
X4 /I =X4 



LATT f I) = X 1 (I)/R0 
LONGT (I) =X3 (I) /(RO 



+DT*X2 (K) +DT**2*WN 1/2. 
+DT*HN T 

+ DT*X4(X) +DT**2*WN2/2. 
+DT*WN2 



*CCS (LATT (I) ) ) 



MEASUREMENTS 
NU=LONGT 
RHO=ACOS 
*COS 
IF 



I) -LONGS (I) 

SINiLATT(I)) 

(RHO. L 

IF { (FLAG1. NE. 1) .OR. (FLAG2. NE.O) ) GOTO 60 



LATT (I 

R HO T £ E *.*R H(j m! ^( ) C GC ^TO^ ^0 



LATS 



* SI N (LATS (I) ) +COS (LATT (I) ) 
COS (NU) ' 



60 



30 



+ 

+ 



10 



c 

c 



COUNT2=K 
FLAG 2= 1 

RANGE (I)=0. 

ALPHA fIJ =0. 

BETA (I) =0. 

GO TO 10 

IF (FLAG 1 . EQ. 0 ) COUNT1 = I 
FLAG1=1 

RANGE (I)= ( RO * * 2 + RS * * 2- 2 . *RO*RS*COS (RHO) ) 5 

+ RSIG*GG NQF (DSEED) 

ALPHA (I) = ASIN (COS (LATT (I) *SIN (NU) /SIN (RHO) ) 

+ ASIG*GGNQF (DSEED) 

IF (LATT (I) .LT.LATS(I) ) ALPH A (I) =PI -ALPHA (I) 
BETA (I) =ASIN ( RO *S IN (RHO /RANGE ( I) ) 

+ ESIG*GGNQF (DSEED) 

CONTINUE 

M=COUNT2-CO UNT 1 + 1 
ESTIMATION 

TARGET NOT YET IN SIGHT 
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40 



CONTINUE 



J=COU NT 1- 1 
DO 4 0 1 = 1 , J 
XHAT1 (I) =0. 
XHAI2 (I) =0. 
XHAT3 (I) =0. 
XHA14 I) =0. 



TWO-POINT INITIALIZATION OF THE EKF 
J=COUNT 1+1 
DO 80 I=COUNT1 ,J 



80 



RH0=ASIN(RAn6e (I) *S I N ( BET A f I) ) /RO) 

LATHAT=A SIN (SIN (LATS (I) ) *COS (RHO) +COS (LATS (I) ) 
*SIN (RHO) *COS (ALPHA (I) ) ) 

NU= ACOS ( (COS (RHO) -SIN(LATHAT) *SIN (LATS (I) ) ) / 
(COS (LATHAT) *COS f IATS (I)) ) ) 

IF (ALPHA(I).GE.PI) NU=-NU 
LONHAT=LONGS (I) +NU 
XHAT1 (I) =R0*LATHAT 
XHAT2 (I) =0. 

XHAT3 i’I) =RO*COS (LATHAT) *LONHAT 
XHAT4 'I =0. 



CONTINUE 
XHAT2 (J) = 
XHAT4 J) = 



= (XHAT1 
(XHAT3 



jjj -XHAT1 



Pi 
PD 
P 4 
P3 
?F 
P9 
PA (J 
PB >T 
PC 
PE 



(COUNT1) ) /DT 
T 1 ) ) /DT 



X EAT 3 (COUN 
‘ =NS2 
=NS2/DT 
=2 . *N S2/DT* *2 
J i =ES2 
^ =ES2/DT 

=2 . *E S2/DT**2 

= 0 . 

= 0 . 

= 0 . 

= 0 . 



UPDATE THE EKF 



J = J+ 1 

DO 50 I=J , COUNT 2 
K=I-1 



C 



STATE AND COVARIANCE 



PN1 

PND 

PN4 

PN3 

PNF 

FN9 

PN3 

PNA 

PNE 

PNC 



= P1 
:PD(K1 
: P 4 >vi 
: P3 



■P F 
= P9 
: P B 
; P A 
: P E 
^PC 






\K l 

K 

K 



= PB (K) 
= P A (K) 



K ) 

kJ 



+ 2. * DT* 
+DT*P4 ( 
+ NS2*DT 
+ 2. *D T* 
+DT*P9 { 
+ ES2* DT 
+DT*(PE 
+ DT *?C ( 
+DT*PC ( 



TMATES 
:at 1=XHAT1 
I AT 2= X HAT 2 
:AT3=XHAT3 
:AT4 = XHAT4 
[ ) +DX **2*P 4' (] 
IS2*DT**3/2. 



SST 
XNH 
XNH 
XNH 
XNH 
PD (K 
K) + N 

PF (K 
K) + E 
2 

^K) + PA (K) ) +DT**2*PC (K) 

K) 



+DT*XHAT2 (K) 

+ DT*XHAT4 (K) 

) + NS2*BT**4/4. 



) +DT**2*P 9 (K) +2S2*DT**4/4. 
S2 T**3 /2 . 



C OBSERVER FUNCTIONS 

LATHAT= XN HAT 1 /HO 
LONHAT=XNHAT3/ (RO*COS(LATHAT) ) 

NUH AT=LON HAT-LONG S ( I ) 

RHOH AT= ACOS (SIN (LATHAT) *SIN (LATS (I) ) +COS (LATHAT) 
+ *COS (LATSjfl) ) *COS (NUHAT) ) 

RHAT= (R0**2+RS**2-2. *RO*itS*COS {RHOHAT) ) **.5 
ALHAT=ASIN (COS (LATH AT) *SIN (NUIiAT) /SIN (RHOHAT) ) 

IF (LATHAT. LT. LATS fl) ) ALH AT= PI-ALH AT 
BEHAT=ASIN (R0*SIN (EH CHAT ) /RHAT) 

DLADX 1=1 . /RO 



123 



+ 

+ 



+ 

+ 

+ 



?} *COS (LATS (I 
* SIN (LATS (I) 
*CC S (LATS (Ij 



n; 



*C05 (NUHAT) - 
/SIN ( RHOHAT) 
SIN (NUHAT) / 



DRHDL A= (SIM (LATHA 
COS (LATHA T 
DRHDNU=C05 (LATHAT 
SIN RHOHAT 

DNODX 1=XNHAT3*SIN (LATHAT) / (RO *COS (LAT HAT) ) **2 
DRHDX 1=DRHELA*DLADX 1 +DRHDNU* DNU DXl 
DRADRH=RO*RS*SIN (RHOHAT) /RHAT 
DNDDX3= 1 . / (EO*COS (LATHAT) ) 

DRADX 1 = DR AERH*DRHDX 1 

DR A DX 3= DR ADR H*DR HDNU *D NUD X3 

BALDL A=-S IN (LATHAT) *SIN (NUHAT) / (COS (ALHAT) 

* SIN (RHOHAT) ) 

DALDRH=-COS (LATHAT) * SIN (NUIIAT) * COS (RHOHAT) / 

(COS i ALHAT ) *S IN (RHOHAT) **2) 

DALDHU=C05 (LATHA T]*CCS (NUHAT) / (COS (ALHAT) 

*S IN (RHOHAT) ) 

DAL dx i=dald£:a*dladxi+daldrh*drhdxi+daldnu*dnudxi 

DA LDX3= (DALDRH*DR HDNU+DALDNU) *DNUDX3 
D3EDRA=— R 0*SIN (RHOHAT) / (RHAT**2*C0S (BEHAT) ) 

DBEDR H=R 0 *COS (RHOHAT)/ (RHAT*COS (BEHAT) ) 

DBEDX 1=DBEDRA*DRADX 1 +DBEDRH*DRHDX 1 
DBEDX 3=DB ZDR A*DR ADX3 +DBEDRH*DRHDNU*DNUDX3 
H 1=DR ADX 1 
H2=DA LDX 1 
H3=DB EDX 1 
H4=DR ADX3 
H5=DA LDX3 
H6=DB EDX3 



EKF 



IF < 


'INK.EQ.2j 


H3=0 


IF | 


’INK. EQ. 2' 


H6=0 


IF l 


INK.EQ. 3 


H 1 = 0 


IF i 


'INK.EQ.3 


H4= 0 


GAINS 







A=RS2+PN 1 *H1 **2+ 
B=PN 1*H1*H2+PNB*( 
C=AS2+PN 1 *H2**2+2 
D=P N 1 *H 1 * H3+PN B* ( 
E=PN1*H2*H3+PNB* 
F=3S2+PN 1 *H3**2+ 
DET=A *C* F + 2. *B*E 



2. *P 
HI* 
. *P 
(HI* 
]H2* 
2. *P 
*D-C 

Q1 = 

Q2= 
Q3 = 
Q4 = 
Q5 = 

Q6 = 
P1 = 
R2 = 
R3 = 
R4 = 
R5 = 
R6 = 
R7 = 
28 = 
R9 = 
RA= 
RB = 
RC = 
G 1 = 
G2 = 
G3 = 
G4 = 
G5 = 
G6 = 
G 7 = 
G8 = 
G9 = 
GA= 



NB*H 1*H4+?N3*H4** 2 
H5+H 2 *H4 ) +PN3*H4*H5 
NB*H2*H5+PN3*H5**2 
E6 + H3*H4) +PN3*H4*H6 
H6 +H3 *H5) +PN3*H5*H6 
NB*H3*H6+PN3*H6**2 
*D**2-F*B**2-A*E**2 
C *F-E**2) /DET 
D*E-B*F) /DET 
A*F-D**2) /DET 
B*E-C*D) /DET 
B*D-A*E[/DET 
A*C-B**2) /DET 
1 *PN 1+H4*PNB 
H2*PN 1 +H5*P N B 
H3*PN 1 + H6 *PNB 
E1*PND+H4*PKE 
H2*PND+H5*PNE 
E3*PN D+H6*PNE 
HI *PNB+H4*PN3 
E2*PNB+H5*PN3 
H3*PNB+H6*PN3 
E1*PNA+H4*?NF 
H2*PNA+H5*?NF 
E3*PNA+H6*PNF 
E1*Q1+R2*Q2+R3*Q4 
El *Q2+R2*Q3+R3*05 
R1 *Q4+R2*Q5+R3*Q6 
E4*Q 1 +R5*Q2+R6*Q4 
E4*Q2+R5*Q3+R6*Q5 
E4*Q4+R5*Q5+E6*Q6 
E7*Q1+R3*Q2+R9*Q4 
E7*Q2 + R3*Q3+R9*Q5 
E7*Q4+R8*Q5+R9*Q6 
EA*Q 1+RB*Q2+RC*Q4 
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GB=RA*Q2+RB*Q3+RC*Q5 
GC=BA*Q4+R3*Q5 +RC*Q6 



STATE AND COVARIANCE UPEATSS 
INNOVA = AL?HA (I) -ALHAT 
INNOV 3=BETA (x^-BEHAT 




XHAT3 

XHAT4 



RHAT 

+Gl*INNOVR+G2*INNOVA+G3*INNOVB 
G 4* I KNGVE + G5*IN N07A+G 6 *INNOV B 
= XNHAT3 + G 7*1 NNOVR + G8*INNOVA +G 9*INNOVB 
=XNKAT4+GA*INNOVR+G3*INNOVA+GC*INNOV£ 
S1 = 1.-G1*H1 -G2 *H2-G3 *H3 
S2=-G1*H4-G2*H5-G3*H6 
S3=-G4*H1-G5*H2-G6*H3 
S4 = -G4* H4-G5* H 5-G6* H6 
S5=-G7*H1-G8*H2-G9*H3 
S6= 1.-G7*H4-G3*H5-G9*H6 
S7 = -GA*H 1-G 3*H 2-GC*H 3 
S8=-GA*H4-GB*H5-GC*H6 



PI 

PD 

P4 

P3 

PF 

P9 

PA 

PB 

PC 

PE 



I) =S 1 *PN 1 + S2*PNB 
I) =S 1 *PND+S2*?NE 
I =S3*PND+S4*PNE+PN4 
I) =S5*PNB+S6*PN3 
I) =S5*PNA+S6*PNF 
I) =S7*PNA + S8*PMF+PN9 
I =S1 *PNA+S2*PNF 
I) =S 1*PNB+S 2*PN3 
I] =S3*PNA+S4*PNF+?NC 
31 =S5*PND+S6*PNE 



PERFORMANCE 



+ XHAT2 (I 
+XHAT3 (I 
+ XHAT4 (Ij 
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AVERAGED 
XAVE1 
XA7E2 
XAVE3 
XAVE4 
E 1 = X 1 
E2 = X2 
E3=X3 
E4 = X4 

SSE (I. 

SSE3AR (x) =SS E3AR (I) + SSE (I) /20. 
CONTINUE 



T - ’ 
1-1. 


) =XAVE1 | 


I 1 ) 


(I 


1 = XAVE2 i 


1 


’I 


| =XAVE3 | 


I 


1 


=XAVE4 | 


I 


(I 


-XHAT1 


I] 


{I 


-XHAT2 | 


I' 


;i; 


-XHAT3 I 


1 


V 


-XHAT4 | 


\u 



AND SQUARED ERROR FUNCTIONS 
+X HAT 1(1) /20. 

*3 . 

/ 20 . 

*3 . 



TARGET OUT OF SIGHT 



J=CO U NT2+ 1 
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CONTINUE 

CONTINUE 

GRAPHICS 



DO 70 I=J, 


, 121 


K=I -1 




XHAT1 (I] 


=XHAT 1 (K) 


XHAT2 (I 


= XH AT2 (K 


XHAT3 (I 


=X HAT3 (K 


XHAT4 (I] 


=XHAT4 (K‘ 



+DT*XKAT2 (K) 
+DT*XHAT4 (K) 
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82 



J=CCUNT 1+2 
K= M-2 

DO 90 3= J, COUNT2 
L=I — J+ 1 

IF { 3NK. NE. 1) GO 
XG 1 (L) = X A V S 3 (I) 
YG 1(L) =XAVE4 (I) 
GO TO 90 

IF (3NK.NE.2) GO 
XG2 (L) =XA VE3 (I) 
YG2]L =XAVE4 (I 
GO TO 90 
XG3 (II =XAVE3 (I) 
YG3 (I) =XA VE 4 (I) 



TO 8 4 



TO 8 2 
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90 

86 



CONTINUE 

CONTINUE 



CALL 

CALL 

CALL 

CALL 

CALL 

CALL 

CALL 

CALL 

CALL 

CALL 

CALL 



LRGBUF 

TEK618 

PAGE {1 1. ,8. 5) 
NOBRDR 

AREA2D (8.5,6) 

ERLY 



XNAHE ( 'EAST; 
YNAME { 'EASTERLY 



H3LES$' , 100) 

, . VELOCITY (KNOTS) $' 

GRAF ( 1262. , 1. , 1272. # -2 1 . , 1. ,-13. ) 
LINES ('RANGE, ALPHA, AND BETAS', IPAK, 
LINES ('RANGE AND ALPHA ONLY$ ' ,IPAK ,2) 
LINES ('ALPHA AND EETA ONLYS ' , IPAK , 3) 



, 100 ) 
1 ) 



XW=XLEGND (IPAK ,3) 
YW=YLEGND (IPAK, 3) 

XL=8. 5-2. 5-XH-. 1 
YL=6. - . 5-YW-.1 

THKCRV (.02) 

CURVE (XG1,YG1, K, 4) 
DASH 

CURVE (XG2,YG2, K,4) 
RESET ( 'EASH') 

DOT 



CALL 

CALL 

CALL 

CALL 

CALL 

CALL 

CALL 

CALL 

CALL 

CALL 

CALL 

CALL 



CURVE (XG3.YG3, K, 4) 

RESET 'DOT') 

RLVEC 126 2. ,-20. , 127 2. ,-20. , 00 00) 
LEGEND (IPAK, 3, XL, YL) 

ENDPL { 0) 

DONEPL 



STOP 

END 
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